Skip to content

Commit

Permalink
auto that runs into the wall really fast
Browse files Browse the repository at this point in the history
  • Loading branch information
@IsaacThoman
IsaacThoman committed Apr 4, 2024
1 parent 2e45f8d commit 753520b
Show file tree
Hide file tree
Showing 8 changed files with 4,017 additions and 3,221 deletions.
2,548 changes: 1,435 additions & 1,113 deletions choreo.chor
View file

Large diffs are not rendered by default.

294 changes: 156 additions & 138 deletions src/main/deploy/choreo/CS-PL-00-01-02-14-13.1.traj
View file
Original file line number Diff line number Diff line change
Expand Up @@ -4,172 +4,190 @@
"x": 1.503187894821167,
"y": 5.59058952331543,
"heading": 3.141592653589793,
"angularVelocity": -2.2382889122052105e-27,
"velocityX": 5.90667727605656e-28,
"velocityY": 3.559318103803996e-27,
"angularVelocity": -5.3381452949261295e-28,
"velocityX": 5.028492750363423e-27,
"velocityY": 2.2885049958656896e-27,
"timestamp": 0
},
{
"x": 1.506695277677012,
"y": 5.604119800469877,
"heading": 3.158516787442155,
"angularVelocity": 0.3147381731371472,
"velocityX": 0.0652268105517928,
"velocityY": 0.2516226089192541,
"timestamp": 0.05377210423403964
},
{
"x": 1.514156620384794,
"y": 5.631341783364944,
"heading": 3.191051590405185,
"angularVelocity": 0.6050498381358539,
"velocityX": 0.13875861497454337,
"velocityY": 0.506247305788626,
"timestamp": 0.10754420846807929
},
{
"x": 1.5262308300950527,
"y": 5.672414858497486,
"heading": 3.2374435589027213,
"angularVelocity": 0.8627515913384751,
"velocityX": 0.22454411785163436,
"velocityY": 0.7638361138662895,
"timestamp": 0.16131631270211894
},
{
"x": 1.5438511830013113,
"y": 5.727397428374488,
"heading": 3.2956941795953534,
"angularVelocity": 1.0832869853688465,
"velocityX": 0.3276857611814318,
"velocityY": 1.0225110335592127,
"timestamp": 0.21508841693615857
},
{
"x": 1.5681965418950492,
"y": 5.7961307719155855,
"heading": 3.363931821947634,
"angularVelocity": 1.2690156601512252,
"velocityX": 0.4527507197370627,
"velocityY": 1.2782342167965037,
"timestamp": 0.2688605211701982
},
{
"x": 1.6006514058238772,
"y": 5.878195128489064,
"heading": 3.440334395557755,
"angularVelocity": 1.4208589137145144,
"velocityX": 0.6035632116528378,
"velocityY": 1.5261511101797014,
"timestamp": 0.32263262540423787
},
{
"x": 1.6430261673400781,
"y": 5.972757341160606,
"heading": 3.5218933561828285,
"angularVelocity": 1.5167522600583592,
"velocityX": 0.7880435798414621,
"velocityY": 1.758573781304269,
"timestamp": 0.37640472963827754
},
{
"x": 1.6978246989731665,
"y": 6.077674980296766,
"heading": 3.6026670907329357,
"angularVelocity": 1.5021494081493387,
"velocityX": 1.0190884737294483,
"velocityY": 1.9511536814611605,
"timestamp": 0.4301768338723172
},
{
"x": 1.766713963685493,
"y": 6.187822558738397,
"heading": 3.671292317853476,
"angularVelocity": 1.276223575366392,
"velocityX": 1.28113388333271,
"velocityY": 2.0484148799946618,
"timestamp": 0.48394893810635686
},
{
"x": 1.8436816171220045,
"y": 6.299882267371157,
"x": 1.4988612913227528,
"y": 5.605738858125541,
"heading": 3.162897638864536,
"angularVelocity": 0.36826452406068066,
"velocityX": -0.07478693637172373,
"velocityY": 0.26186183664230345,
"timestamp": 0.057852396532315734
},
{
"x": 1.4909518991993862,
"y": 5.636302524373402,
"heading": 3.205539377822536,
"angularVelocity": 0.737078176773204,
"velocityX": -0.13671675846563242,
"velocityY": 0.5283042376781836,
"timestamp": 0.11570479306463147
},
{
"x": 1.4806762327704113,
"y": 5.682834122822902,
"heading": 3.268415496912473,
"angularVelocity": 1.0868368962868356,
"velocityX": -0.17761868210999887,
"velocityY": 0.8043158319899057,
"timestamp": 0.17355718959694721
},
{
"x": 1.4708788377073132,
"y": 5.7464323530347325,
"heading": 3.3469763695999935,
"angularVelocity": 1.3579536440402666,
"velocityX": -0.16935158524721214,
"velocityY": 1.0993188532182199,
"timestamp": 0.23140958612926293
},
{
"x": 1.4684294292380262,
"y": 5.826771025278315,
"heading": 3.433314626586324,
"angularVelocity": 1.4923885985968215,
"velocityX": -0.042338928309025255,
"velocityY": 1.388683564711213,
"timestamp": 0.28926198266157865
},
{
"x": 1.4815505218466947,
"y": 5.917413803485394,
"heading": 3.516859540129071,
"angularVelocity": 1.444104627473463,
"velocityX": 0.22680292252610784,
"velocityY": 1.5667938346589654,
"timestamp": 0.3471143791938944
},
{
"x": 1.5122338889622358,
"y": 6.009357332195097,
"heading": 3.5878240632253164,
"angularVelocity": 1.2266479411376736,
"velocityX": 0.530373311300971,
"velocityY": 1.5892777865882317,
"timestamp": 0.4049667757262101
},
{
"x": 1.5596594149930991,
"y": 6.097116778254511,
"heading": 3.6450574433130614,
"angularVelocity": 0.9893000725695895,
"velocityX": 0.8197676997593678,
"velocityY": 1.5169543756133446,
"timestamp": 0.4628191722585258
},
{
"x": 1.621877761136067,
"y": 6.177134153277719,
"heading": 3.6858577892525877,
"angularVelocity": 0.7052490196622307,
"velocityX": 1.0754670484257896,
"velocityY": 1.3831298238182983,
"timestamp": 0.5206715687908415
},
{
"x": 1.6972294494700848,
"y": 6.247932182261191,
"heading": 3.7070763066436343,
"angularVelocity": 0.6654749576920127,
"velocityX": 1.431367705111831,
"velocityY": 2.0839747714731,
"timestamp": 0.5377210423403965
"angularVelocity": 0.36676989481661876,
"velocityX": 1.3024817094988796,
"velocityY": 1.2237700290242006,
"timestamp": 0.5785239653231573
},
{
"x": 1.925526022911072,
"y": 6.406276226043701,
"x": 1.7847588062286377,
"y": 6.308822154998779,
"heading": 3.7070763066436343,
"angularVelocity": -1.654168761583474e-27,
"velocityX": 1.5220606847157223,
"velocityY": 1.9786088007542086,
"timestamp": 0.5914931465744362
"angularVelocity": -2.584451249372658e-27,
"velocityX": 1.5129771972308863,
"velocityY": 1.0525056244398752,
"timestamp": 0.6363763618554731
},
{
"x": 2.060211431291083,
"y": 6.530472267317925,
"x": 1.9126085900177852,
"y": 6.39776111374038,
"heading": 3.7070763066436343,
"angularVelocity": 9.124888245553447e-28,
"velocityX": 1.7659137033212415,
"velocityY": 1.6283834590722537,
"timestamp": 0.6677626766917355
"angularVelocity": 2.3263502410123673e-24,
"velocityX": 1.8333011972524855,
"velocityY": 1.2753396580808742,
"timestamp": 0.7061138299707791
},
{
"x": 2.1912032986875114,
"y": 6.622329950986639,
"x": 2.0627969482977644,
"y": 6.50223994666951,
"heading": 3.7070763066436343,
"angularVelocity": 4.064391409302306e-27,
"velocityX": 1.7174862254293242,
"velocityY": 1.2043824516480073,
"timestamp": 0.7440322068090348
"angularVelocity": 2.3197388710735814e-24,
"velocityX": 2.153625050333823,
"velocityY": 1.4981735895025852,
"timestamp": 0.7758512980860851
},
{
"x": 2.3028956716955715,
"y": 6.6879780665201105,
"x": 2.196828467998306,
"y": 6.595479242407234,
"heading": 3.7070763066436343,
"angularVelocity": 2.8257526336576813e-28,
"velocityX": 1.4644429149659381,
"velocityY": 0.8607384289965739,
"timestamp": 0.8203017369263341
"angularVelocity": 2.3233849862447512e-24,
"velocityX": 1.9219441617658066,
"velocityY": 1.3370043142885497,
"timestamp": 0.8455887662013911
},
{
"x": 2.389341389992124,
"y": 6.733083090322285,
"x": 2.3085214132079,
"y": 6.673178663957348,
"heading": 3.7070763066436343,
"angularVelocity": 3.2624947185882234e-27,
"velocityX": 1.133424031374029,
"velocityY": 0.5913898215028391,
"timestamp": 0.8965712670436334
"angularVelocity": 2.2680495176951543e-24,
"velocityX": 1.6016203086828131,
"velocityY": 1.1141703828656866,
"timestamp": 0.9153262343166971
},
{
"x": 2.4480496219960086,
"y": 6.761157430315703,
"x": 2.3978757736793916,
"y": 6.735338204191398,
"heading": 3.7070763066436343,
"angularVelocity": -7.947249957327671e-28,
"velocityX": 0.7697468689474524,
"velocityY": 0.36809378463772646,
"timestamp": 0.9728407971609327
"angularVelocity": 2.2440269585177072e-24,
"velocityX": 1.2812963086607951,
"velocityY": 0.8913363492243962,
"timestamp": 0.9850637024320031
},
{
"x": 2.477766275405884,
"y": 6.7744364738464355,
"x": 2.464891545997055,
"y": 6.781957860733226,
"heading": 3.7070763066436343,
"angularVelocity": -1.3094660271348824e-27,
"velocityX": 0.38962680593642596,
"velocityY": 0.17410679612565608,
"timestamp": 1.049110327278232
"angularVelocity": 2.317179820909991e-24,
"velocityX": 0.9609722596589972,
"velocityY": 0.6685022815102234,
"timestamp": 1.054801170547309
},
{
"x": 2.477766275405884,
"y": 6.7744364738464355,
"x": 2.509568728453025,
"y": 6.813037632394755,
"heading": 3.7070763066436343,
"angularVelocity": 2.090952964757395e-27,
"velocityX": 9.368528338950605e-27,
"velocityY": 8.790177468981121e-28,
"timestamp": 1.1253798573955314
"angularVelocity": 2.3247950900824722e-24,
"velocityX": 0.6406481861672896,
"velocityY": 0.44566819675959585,
"timestamp": 1.124538638662615
},
{
"x": 2.531907320022583,
"y": 6.828577518463135,
"heading": 3.7070763066436343,
"angularVelocity": 2.3337661727304464e-24,
"velocityX": 0.32032409798163003,
"velocityY": 0.22283410178709118,
"timestamp": 1.194276106777921
},
{
"x": 2.531907320022583,
"y": 6.828577518463135,
"heading": 3.7070763066436343,
"angularVelocity": 7.625858823425053e-25,
"velocityX": 2.9808360933957585e-19,
"velocityY": -4.2849532527242106e-19,
"timestamp": 1.264013574893227
}
],
"eventMarkers": []
Expand Down
Loading

0 comments on commit 753520b

Please sign in to comment.