Skip to content

Commit

Permalink
Added Choreo Settings & Test Path
Browse files Browse the repository at this point in the history
  • Loading branch information
rechsby authored and mmilunicmobile committed Dec 16, 2024
1 parent 3d44bbc commit 00bc4da
Show file tree
Hide file tree
Showing 3 changed files with 171 additions and 0 deletions.
78 changes: 78 additions & 0 deletions src/main/deploy/choreo/QuarterSprint.traj
Original file line number Diff line number Diff line change
@@ -0,0 +1,78 @@
{
"name":"QuarterSprint",
"version":"v2025.0.0",
"snapshot":{
"waypoints":[
{"x":0.0, "y":0.0, "heading":0.0, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false},
{"x":3.255356550216675, "y":1.1777058839797974, "heading":0.0, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false},
{"x":4.409422397613525, "y":1.5689146518707275, "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}],
"targetDt":0.05
},
"params":{
"waypoints":[
{"x":{"exp":"0 m", "val":0.0}, "y":{"exp":"0 m", "val":0.0}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false},
{"x":{"exp":"3.255356550216675 m", "val":3.255356550216675}, "y":{"exp":"1.1777058839797974 m", "val":1.1777058839797974}, "heading":{"exp":"0 deg", "val":0.0}, "intervals":16, "split":false, "fixTranslation":true, "fixHeading":false, "overrideIntervals":false},
{"x":{"exp":"4.409422397613525 m", "val":4.409422397613525}, "y":{"exp":"1.5689146518707275 m", "val":1.5689146518707275}, "heading":{"exp":"0 rad", "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}],
"targetDt":{
"exp":"0.05 s",
"val":0.05
}
},
"trajectory":{
"waypoints":[0.0,1.167238832817363,1.7203497483025445],
"samples":[
{"t":0.0, "x":0.0, "y":0.0, "heading":0.0, "vx":0.0, "vy":0.0, "omega":0.0, "ax":7.843324654423512, "ay":2.8403284449533, "alpha":0.0, "fx":[145.27405924923227,145.27405924923227,145.27405924923227,145.27405924923227], "fy":[52.60856345742503,52.60856345742502,52.608563457425014,52.60856345742502]},
{"t":0.04168710117204868, "x":0.006815121280357164, "y":0.0024679818420480447, "heading":0.0, "vx":0.3269654683941767, "vy":0.1184050592466159, "omega":0.0, "ax":7.842445124066024, "ay":2.8400099377936616, "alpha":0.0, "fx":[145.2577685879509,145.2577685879509,145.2577685879509,145.2577685879509], "fy":[52.6026640678142,52.60266406781419,52.60266406781419,52.6026640678142]},
{"t":0.08337420234409736, "x":0.02725972089116675, "y":0.009871650615029334, "heading":0.0, "vx":0.6538942717173568, "vy":0.23679684085304392, "omega":0.0, "ax":7.841345579725829, "ay":2.8396117562622702, "alpha":0.0, "fx":[145.2374028276818,145.2374028276818,145.2374028276818,145.2374028276818], "fy":[52.59528894948978,52.59528894948976,52.59528894948976,52.59528894948976]},
{"t":0.12506130351614603, "x":0.06133207920017044, "y":0.022210383582973225, "heading":0.0, "vx":0.980777238224384, "vy":0.35517202342568804, "omega":0.0, "ax":7.839931702097867, "ay":2.8390997442054275, "alpha":0.0, "fx":[145.2112149862567,145.2112149862567,145.2112149862567,145.2112149862567], "fy":[52.58580546217293,52.58580546217292,52.58580546217293,52.58580546217293]},
{"t":0.1667484046881947, "x":0.10903001227691798, "y":0.0394833898721103, "heading":0.0, "vx":1.3076012642716897, "vy":0.4735258616999172, "omega":0.0, "ax":7.838046309070132, "ay":2.838416980758959, "alpha":0.0, "fx":[145.17629373659696,145.17629373659696,145.17629373659696,145.17629373659696], "fy":[52.57315931761744,52.57315931761742,52.573159317617424,52.57315931761744]},
{"t":0.2084355058602434, "x":0.17035065336137825, "y":0.06168963133341607, "heading":0.0, "vx":1.6343466937490991, "vy":0.5918512375452769, "omega":0.0, "ax":7.835406546233246, "ay":2.8374610349450604, "alpha":0.0, "fx":[145.12740004933218,145.12740004933218,145.12740004933218,145.12740004933218], "fy":[52.55545328925241,52.5554532892524,52.5554532892524,52.555453289252405]},
{"t":0.25012260703229205, "x":0.24529007051302404, "y":0.08882768408061294, "heading":0.0, "vx":1.960982079166057, "vy":0.7101367627807775, "omega":0.0, "ax":7.831447024288082, "ay":2.8360271605175185, "alpha":0.0, "fx":[145.05406178386383,145.05406178386383,145.05406178386383,145.05406178386383], "fy":[52.52889506710548,52.52889506710547,52.528895067105466,52.52889506710548]},
{"t":0.2918097082043407, "x":0.3338425295657846, "y":0.12089547158165456, "heading":0.0, "vx":2.287452403591094, "vy":0.8283625139479492, "omega":0.0, "ax":7.824850128661498, "ay":2.8336382054692546, "alpha":0.0, "fx":[144.9318740830683,144.9318740830683,144.9318740830683,144.9318740830683], "fy":[52.48464684170153,52.484646841701526,52.48464684170152,52.48464684170153]},
{"t":0.33349680937638937, "x":0.4359988579724038, "y":0.15788967215249483, "heading":0.0, "vx":2.613647722560724, "vy":0.9464886765043286, "omega":0.0, "ax":7.811674842078864, "ay":2.828866996529874, "alpha":0.0, "fx":[144.68784142498473,144.68784142498473,144.68784142498473,144.68784142498473], "fy":[52.396274509726325,52.39627450972631,52.396274509726304,52.39627450972631]},
{"t":0.375183910548438, "x":0.5517418755413542, "y":0.19980406427511452, "heading":0.0, "vx":2.9392938020256127, "vy":1.064415941190939, "omega":0.0, "ax":7.772412877764403, "ay":2.8146489350179333, "alpha":0.0, "fx":[143.96063132195226,143.96063132195226,143.96063132195226,143.96063132195223], "fy":[52.132927574402146,52.13292757440215,52.132927574402146,52.13292757440215]},
{"t":0.4168710117204867, "x":0.6810260191676814, "y":0.24662214803558455, "heading":0.0, "vx":3.2633031640119112, "vy":1.1817504961088303, "omega":0.0, "ax":4.11867595535417, "ay":1.4915093883392592, "alpha":0.0, "fx":[76.28611604506992,76.28611604506993,76.28611604506995,76.28611604506995], "fy":[27.625736890819766,27.62573689081975,27.62573689081975,27.62573689081976]},
{"t":0.45855811289253534, "x":0.8206424155214849, "y":0.29718188377646043, "heading":0.0, "vx":3.434998825257645, "vy":1.24392719887959, "omega":0.0, "ax":0.001163608544372028, "ay":0.0004214105896075762, "alpha":0.0, "fx":[0.021552357458913044,0.02155235745891302,0.021552357458804364,0.021552357458804364], "fy":[0.007805366940657207,0.007805366940765848,0.007805366940765848,0.0078053669406572]},
{"t":0.500245214064584, "x":0.9638385701437197, "y":0.3490379689335207, "heading":0.0, "vx":3.435047332724759, "vy":1.2439447662654737, "omega":0.0, "ax":2.419596442938799e-7, "ay":6.530547040715496e-8, "alpha":0.0, "fx":[4.4815765329430725e-6,4.4815765329430725e-6,4.481576530217332e-6,4.481576530217332e-6], "fy":[1.209587921699512e-6,1.2095879244243015e-6,1.2095879244243015e-6,1.209587921699512e-6]},
{"t":0.5419323152366327, "x":1.1070357360440353, "y":0.4008944203140134, "heading":0.0, "vx":3.435047342811355, "vy":1.2439447689878695, "omega":0.0, "ax":-1.848202319580021e-9, "ay":5.251587359248084e-9, "alpha":0.0, "fx":[-3.4232406028753224e-8,-3.4232406028753224e-8,-3.4232400697769265e-8,-3.4232400697769265e-8], "fy":[9.726990373340697e-8,9.726989840257505e-8,9.726989840257505e-8,9.726990373340613e-8]},
{"t":0.5836194164086813, "x":1.2502329021529828, "y":0.4527508717558056, "heading":0.0, "vx":3.4350473427343085, "vy":1.2439447692067929, "omega":0.0, "ax":-2.5433841203915605e-10, "ay":7.02457953621633e-10, "alpha":0.0, "fx":[-4.710856811743995e-9,-4.710856811743995e-9,-4.710855497764548e-9,-4.710855497764548e-9], "fy":[1.3010926998210282e-8,1.3010925684196636e-8,1.3010925684196636e-8,1.3010926998210282e-8]},
{"t":0.62530651758073, "x":1.3934300682601073, "y":0.5046073232027715, "heading":0.0, "vx":3.435047342723706, "vy":1.2439447692360763, "omega":0.0, "ax":1.2509313593169655e-10, "ay":-3.4553939047662395e-10, "alpha":0.0, "fx":[2.3169738963337735e-9,2.3169738963337735e-9,2.3169762311219915e-9,2.3169762311219915e-9], "fy":[-6.400079422996369e-9,-6.400081757813889e-9,-6.400081757813889e-9,-6.400079422996369e-9]},
{"t":0.6669936187527786, "x":1.5366272343671143, "y":0.5564637746500617, "heading":0.0, "vx":3.4350473427289208, "vy":1.243944769221672, "omega":0.0, "ax":3.2839828924789705e-10, "ay":-9.067542350380939e-10, "alpha":0.0, "fx":[6.082591521344399e-9,6.082591521344399e-9,6.082594550562097e-9,6.082594550562097e-9], "fy":[-1.6794900238971255e-8,-1.6794903268073518e-8,-1.6794903268073518e-8,-1.6794900238971255e-8]},
{"t":0.7086807199248273, "x":1.679824400474523, "y":0.608320226096242, "heading":0.0, "vx":3.4350473427426103, "vy":1.243944769183872, "omega":0.0, "ax":1.709704005108549e-9, "ay":-4.721304929512053e-9, "alpha":0.0, "fx":[3.166713599760507e-8,3.166713599760507e-8,3.166713916763461e-8,3.166713916763461e-8], "fy":[-8.74480083193618e-8,-8.744801148948405e-8,-8.744801148948405e-8,-8.74480083193618e-8]},
{"t":0.7503678210968759, "x":1.823021566583697, "y":0.6601766775375526, "heading":0.0, "vx":3.435047342813883, "vy":1.2439447689870542, "omega":0.0, "ax":1.1513392709648542e-8, "ay":-3.1793082707172943e-8, "alpha":0.0, "fx":[2.132510588375459e-7,2.132510588375459e-7,2.1325106053573229e-7,2.1325106053573229e-7], "fy":[-5.888714770059387e-7,-5.888714787039937e-7,-5.888714787039937e-7,-5.888714770059387e-7]},
{"t":0.7920549222689246, "x":1.966218732704358, "y":0.7120331289471263, "heading":0.0, "vx":3.435047343293843, "vy":1.2439447676616928, "omega":0.0, "ax":7.590857586873053e-8, "ay":-2.0961523706577566e-7, "alpha":0.0, "fx":[1.4059786392022851e-6,1.4059786392022851e-6,1.4059786452789668e-6,1.4059786452789668e-6], "fy":[-3.882493417893814e-6,-3.882493423970774e-6,-3.882493423970774e-6,-3.882493417893814e-6]},
{"t":0.8337420234409733, "x":2.109415898900989, "y":0.763889580146949, "heading":0.0, "vx":3.435047346458252, "vy":1.2439447589234414, "omega":0.0, "ax":5.011430372535647e-7, "ay":-1.3838636719124269e-6, "alpha":0.0, "fx":[9.282171333707528e-6,9.282171333707528e-6,9.282171338163714e-6,9.282171338163714e-6], "fy":[-0.000025631922928838947,-0.000025631922933295007,-0.000025631922933295007,-0.000025631922928838947]},
{"t":0.8754291246130219, "x":2.252613065599016, "y":0.8157460299621533, "heading":0.0, "vx":3.435047367349452, "vy":1.2439447012341764, "omega":0.0, "ax":3.304475231669559e-6, "ay":-9.125028714152548e-6, "alpha":0.0, "fx":[0.00006120549024009215,0.00006120549024009215,0.00006120549024187499,0.00006120549024187499], "fy":[-0.00016901378184264206,-0.00016901378184442493,-0.00016901378184442493,-0.00016901378184264206]},
{"t":0.9171162257850706, "x":2.3958102356037783, "y":0.8676024706461424, "heading":0.0, "vx":3.4350475051034457, "vy":1.2439443208381813, "omega":0.0, "ax":0.00002177211736237517, "ay":-0.00006012193801745443, "alpha":0.0, "fx":[0.00040326315778356866,0.00040326315778356866,0.00040326315778808615,0.00040326315778808615], "fy":[-0.0011135785359564123,-0.0011135785359609296,-0.0011135785359609296,-0.0011135785359564123]},
{"t":0.9588033269571192, "x":2.539007427397767, "y":0.9194588511609274, "heading":0.0, "vx":3.435048412719905, "vy":1.2439418145288683, "omega":0.0, "ax":0.00014341586187092628, "ay":-0.0003960347328959736, "alpha":0.0, "fx":[0.002656348593573672,0.002656348593573672,0.0026563485935729206,0.0026563485935729206], "fy":[-0.007335355322699598,-0.007335355322698847,-0.007335355322698847,-0.007335355322699598]},
{"t":1.000490428129168, "x":2.682204762724788, "y":0.971314835317904, "heading":0.0, "vx":3.435054391311448, "vy":1.2439253049888903, "omega":0.0, "ax":0.0009446479606479784, "ay":-0.0026087412084742187, "alpha":0.0, "fx":[0.01749676952711678,0.01749676952711678,0.017496769527125918,0.017496769527125918], "fy":[-0.048319104663354526,-0.04831910466336366,-0.04831910466336366,-0.048319104663354526]},
{"t":1.0421775293012168, "x":2.8254030434782944, "y":1.0231682086034168, "heading":0.0, "vx":3.4350937709465557, "vy":1.243816554130201, "omega":0.0, "ax":0.006220886048813942, "ay":-0.017186104788871382, "alpha":0.0, "fx":[0.11522325139612848,0.11522325139612848,0.11522325139613518,0.11522325139613518], "fy":[-0.31832103289947233,-0.318321032899479,-0.318321032899479,-0.31832103289947233]},
{"t":1.0838646304732655, "x":2.9686075504159115, "y":1.075004382004684, "heading":0.0, "vx":3.4353531016526526, "vy":1.243100115241114, "omega":0.0, "ax":0.04088306912899751, "ay":-0.11323172749352084, "alpha":0.0, "fx":[0.7572362064072937,0.7572362064072937,0.757236206407294,0.757236206407294], "fy":[-2.0972780566349947,-2.097278056634995,-2.097278056634995,-2.0972780566349947]},
{"t":1.1255517316453143, "x":3.1118529863194224, "y":1.126727234412214, "heading":0.0, "vx":3.437057398291657, "vy":1.2383798127612058, "omega":0.0, "ax":0.25618892328299037, "ay":-0.7432496529845579, "alpha":0.0, "fx":[4.745131237047545,4.745131237047545,4.74513123704755,4.74513123704755], "fy":[-13.766470072579978,-13.766470072579985,-13.766470072579985,-13.766470072579978]},
{"t":1.167238832817363, "x":3.255356550216675, "y":1.1777058839797974, "heading":0.0, "vx":3.447737171855713, "vy":1.2073958892811485, "omega":0.0, "ax":0.2823829412414288, "ay":-0.8499454091256985, "alpha":0.0, "fx":[5.2302968376737455,5.2302968376737455,5.230296837673745,5.230296837673745], "fy":[-15.742688867826184,-15.742688867826182,-15.742688867826182,-15.742688867826184]},
{"t":1.201808265035187, "x":3.3747115969359243, "y":1.2189370125550096, "heading":0.0, "vx":3.457498989802428, "vy":1.1780137590715278, "omega":0.0, "ax":0.06468951865712697, "ay":-0.19047330926538183, "alpha":0.0, "fx":[1.1981792645673013,1.1981792645673013,1.1981792645673095,1.1981792645673095], "fy":[-3.5279466342133987,-3.5279466342134076,-3.5279466342134076,-3.5279466342133987]},
{"t":1.2363776972530107, "x":3.4942740273708215, "y":1.2595464672016805, "heading":0.0, "vx":3.4597352697328496, "vy":1.1714292049175727, "omega":0.0, "ax":0.010091996376742442, "ay":-0.04521699320873902, "alpha":0.0, "fx":[0.18692395689002472,0.18692395689002472,0.18692395689002217,0.1869239568900222], "fy":[-0.8375091482122654,-0.837509148212263,-0.837509148212263,-0.8375091482122654]},
{"t":1.2709471294708343, "x":3.6138811414676377, "y":1.300015091513686, "heading":0.0, "vx":3.460084144317538, "vy":1.169866079135749, "omega":0.0, "ax":-5.5158394174879035, "ay":-1.8739779591343015, "alpha":0.0, "fx":[-102.1643776907109,-102.16437769071092,-102.164377690711,-102.16437769071098], "fy":[-34.70981975908564,-34.709819759085455,-34.70981975908542,-34.7098197590856]},
{"t":1.3055165616886584, "x":3.730198445828517, "y":1.3393369530418986, "heading":0.0, "vx":3.2694047074502883, "vy":1.1050837250997607, "omega":0.0, "ax":-7.798982128601342, "ay":-2.6365038674192856, "alpha":0.0, "fx":[-144.45274698595404,-144.45274698595404,-144.45274698595404,-144.452746985954], "fy":[-48.83332463234001,-48.83332463234001,-48.83332463234001,-48.83332463234001]},
{"t":1.3400859939064822, "x":3.8385598404456966, "y":1.3759636987408497, "heading":0.0, "vx":2.999798323387585, "vy":1.0139412833629793, "omega":0.0, "ax":-7.853807076209527, "ay":-2.654776635403731, "alpha":0.0, "fx":[-145.46821466555284,-145.46821466555284,-145.46821466555284,-145.46821466555284], "fy":[-49.171772840947895,-49.1717728409479,-49.17177284094791,-49.1717728409479]},
{"t":1.374655426124306, "x":3.93756833628613, "y":1.409428783582123, "heading":0.0, "vx":2.728296672014694, "vy":0.9221671624119272, "omega":0.0, "ax":-7.872545015993208, "ay":-2.661021583699936, "alpha":0.0, "fx":[-145.81527878622617,-145.81527878622617,-145.81527878622617,-145.81527878622617], "fy":[-49.287441773290205,-49.28744177329021,-49.28744177329022,-49.287441773290205]},
{"t":1.4092248583421298, "x":4.0271799778456945, "y":1.4397175576707033, "heading":0.0, "vx":2.4561472607025494, "vy":0.830177157144046, "omega":0.0, "ax":-7.881991054915628, "ay":-2.6641697046973754, "alpha":0.0, "fx":[-145.99023831914724,-145.99023831914724,-145.99023831914724,-145.99023831914727], "fy":[-49.34575127040476,-49.34575127040477,-49.34575127040478,-49.34575127040476]},
{"t":1.4437942905599537, "x":4.107377924553981, "y":1.466824408433353, "heading":0.0, "vx":2.18367130518815, "vy":0.7380783231207303, "omega":0.0, "ax":-7.887680756603811, "ay":-2.6660659265819793, "alpha":0.0, "fx":[-146.09562297381578,-146.0956229738158,-146.09562297381578,-146.09562297381578], "fy":[-49.38087309215141,-49.38087309215142,-49.38087309215142,-49.38087309215141]},
{"t":1.4783637227777775, "x":4.178153132460479, "y":1.4907463217600367, "heading":0.0, "vx":1.9109986599169009, "vy":0.6459139377835048, "omega":0.0, "ax":-7.89148220995767, "ay":-2.667332844588643, "alpha":0.0, "fx":[-146.16603349283594,-146.16603349283594,-146.16603349283594,-146.16603349283594], "fy":[-49.404338947470826,-49.40433894747085,-49.40433894747085,-49.40433894747084]},
{"t":1.512933154995601, "x":4.23949993038356, "y":1.511481407602395, "heading":0.0, "vx":1.638194600561606, "vy":0.5537057558101224, "omega":0.0, "ax":-7.894201248874816, "ay":-2.668239023583038, "alpha":0.0, "fx":[-146.21639553165932,-146.21639553165932,-146.21639553165932,-146.21639553165932], "fy":[-49.42112319480503,-49.421123194805034,-49.42112319480505,-49.42112319480503]},
{"t":1.5475025872134252, "x":4.29141442218014, "y":1.529028367485593, "heading":0.0, "vx":1.3652965455747674, "vy":0.46146624774341594, "omega":0.0, "ax":-7.896242393798908, "ay":-2.668919279632094, "alpha":0.0, "fx":[-146.25420161794338,-146.25420161794335,-146.25420161794335,-146.25420161794338], "fy":[-49.43372289734563,-49.433722897345646,-49.43372289734565,-49.43372289734564]},
{"t":1.582072019431249, "x":4.3338937635318135, "y":1.5433862534782723, "heading":0.0, "vx":1.0923279293668289, "vy":0.36920322361133096, "omega":0.0, "ax":-7.897830973424849, "ay":-2.6694487086207266, "alpha":0.0, "fx":[-146.28362528977505,-146.28362528977505,-146.28362528977505,-146.28362528977505], "fy":[-49.44352898107308,-49.4435289810731,-49.4435289810731,-49.44352898107309]},
{"t":1.6166414516490728, "x":4.366935785595301, "y":1.5545543427661028, "heading":0.0, "vx":0.8193043968631883, "vy":0.2769218974197093, "omega":0.0, "ax":-7.899102437558736, "ay":-2.669872452180924, "alpha":0.0, "fx":[-146.3071753484629,-146.3071753484629,-146.3071753484629,-146.3071753484629], "fy":[-49.45137755929507,-49.45137755929508,-49.45137755929508,-49.45137755929507]},
{"t":1.6512108838668966, "x":4.390538779429227, "y":1.5625320658068087, "heading":0.0, "vx":0.5462369105663543, "vy":0.18462592265380565, "omega":0.0, "ax":-7.900143100164455, "ay":-2.6702192763008914, "alpha":0.0, "fx":[-146.32645050124603,-146.32645050124603,-146.32645050124603,-146.32645050124603], "fy":[-49.45780143564509,-49.4578014356451,-49.4578014356451,-49.457801435645095]},
{"t":1.6857803160847205, "x":4.404701363485043, "y":1.567318962168469, "heading":0.0, "vx":0.2731334491541101, "vy":0.09231795837499523, "omega":0.0, "ax":-7.901010564277751, "ay":-2.670508378422148, "alpha":0.0, "fx":[-146.34251767155249,-146.34251767155249,-146.34251767155249,-146.34251767155249], "fy":[-49.46315618513505,-49.46315618513506,-49.46315618513507,-49.463156185135055]},
{"t":1.7203497483025445, "x":4.409422397613525, "y":1.5689146518707275, "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":[]
}
Loading

0 comments on commit 00bc4da

Please sign in to comment.