Skip to content

Commit

Permalink
4 piece auto
Browse files Browse the repository at this point in the history
  • Loading branch information
@eshen7
eshen7 committed Jan 30, 2024
1 parent ce58e68 commit fedc2cd
Show file tree
Hide file tree
Showing 21 changed files with 2,078 additions and 2,033 deletions.
1,922 changes: 961 additions & 961 deletions choreo.chor
View file

Large diffs are not rendered by default.

714 changes: 357 additions & 357 deletions src/main/deploy/choreo/n1 to n2.traj
View file

Large diffs are not rendered by default.

714 changes: 357 additions & 357 deletions src/main/deploy/choreo/n2 to n3.traj
View file

Large diffs are not rendered by default.

358 changes: 179 additions & 179 deletions src/main/deploy/choreo/s1 to n1.traj
View file
Original file line number Diff line number Diff line change
Expand Up @@ -4,190 +4,190 @@
"x": 0.7777742147445679,
"y": 6.587954998016357,
"heading": 1.04,
"angularVelocity": 3.456261362722889e-34,
"velocityX": -1.1558052906437545e-31,
"angularVelocity": 0,
"velocityX": 0,
"velocityY": 0,
"timestamp": 0
},
{
"x": 0.7963313164649566,
"y": 6.590858044372771,
"heading": 1.0212479427537267,
"angularVelocity": -0.5403793813658812,
"velocityX": 0.5347613339651155,
"velocityY": 0.08365729549312781,
"timestamp": 0.034701652011361266
},
{
"x": 0.8334366047936193,
"y": 6.597354793156111,
"heading": 0.9842134904961697,
"angularVelocity": -1.0672244723516933,
"velocityX": 1.0692657605036897,
"velocityY": 0.1872172766072533,
"timestamp": 0.06940330402272253
},
{
"x": 0.8888948620431416,
"y": 6.60825583696797,
"heading": 0.9287093637187599,
"angularVelocity": -1.5994664103956173,
"velocityX": 1.5981445849138671,
"velocityY": 0.3141361629783576,
"timestamp": 0.10410495603408379
},
{
"x": 0.9624427298967876,
"y": 6.624092354477085,
"heading": 0.8539129665807309,
"angularVelocity": -2.1554131519024216,
"velocityX": 2.1194341937832384,
"velocityY": 0.4563620632219429,
"timestamp": 0.13880660804544506
},
{
"x": 1.0542492622786634,
"y": 6.644882073171641,
"heading": 0.7600424721123056,
"angularVelocity": -2.705072785517315,
"velocityX": 2.645595441733396,
"velocityY": 0.5990988177666401,
"timestamp": 0.17350826005680633
},
{
"x": 1.1664507744572048,
"y": 6.671052140823148,
"heading": 0.6611723277837077,
"angularVelocity": -2.8491480548599815,
"velocityX": 3.233319040309866,
"velocityY": 0.7541447203418256,
"timestamp": 0.2082099120681676
},
{
"x": 1.2913236884116448,
"y": 6.70181970935028,
"heading": 0.6001895893740606,
"angularVelocity": -1.7573439555466015,
"velocityX": 3.598471735972595,
"velocityY": 0.8866312334945337,
"timestamp": 0.24291156407952888
},
{
"x": 1.4286273378821592,
"y": 6.734134961997154,
"heading": 0.577040600299819,
"angularVelocity": -0.6670860818574766,
"velocityX": 3.9566891347294235,
"velocityY": 0.9312309580044206,
"timestamp": 0.2776132160908901
},
{
"x": 1.5744661161236646,
"y": 6.762134785686582,
"heading": 0.577039742085532,
"angularVelocity": -0.00002473122278590041,
"velocityX": 4.202646553938067,
"velocityY": 0.8068729315901393,
"timestamp": 0.3123148681022514
},
{
"x": 1.7203049375629715,
"y": 6.790134384466256,
"heading": 0.577038883923436,
"angularVelocity": -0.000024729718795994622,
"velocityX": 4.202647798772216,
"velocityY": 0.8068664503495967,
"timestamp": 0.34701652011361267
},
{
"x": 1.8657539829456187,
"y": 6.820090502206212,
"heading": 0.5770365067477514,
"angularVelocity": -0.0000685032425500324,
"velocityX": 4.191415594134462,
"velocityY": 0.8632475978419899,
"timestamp": 0.38171817212497394
},
{
"x": 1.9989519675183611,
"y": 6.8523001934695875,
"heading": 0.5408190014813394,
"angularVelocity": -1.0436824521943329,
"velocityX": 3.838375894298458,
"velocityY": 0.9281889880294489,
"timestamp": 0.4164198241363352
},
{
"x": 2.1201153456577337,
"y": 6.881905888069826,
"heading": 0.4637582440967774,
"angularVelocity": -2.2206653838650827,
"velocityX": 3.491573775787503,
"velocityY": 0.8531494290400246,
"timestamp": 0.4511214761476965
},
{
"x": 2.230128544512573,
"y": 6.907090743568618,
"heading": 0.3438736710895332,
"angularVelocity": -3.4547223563879386,
"velocityX": 3.1702582579878573,
"velocityY": 0.7257537909303905,
"timestamp": 0.48582312815905776
},
{
"x": 2.320682619145,
"y": 6.924998011921803,
"heading": 0.23280303009322398,
"angularVelocity": -3.2007306441763914,
"velocityX": 2.6095032767540833,
"velocityY": 0.5160350391192005,
"timestamp": 0.520524780170419
},
{
"x": 2.3926583087168334,
"y": 6.938338116341775,
"heading": 0.14104839688844084,
"angularVelocity": -2.644099859417151,
"velocityX": 2.0741286192446693,
"velocityY": 0.38442274781631036,
"timestamp": 0.5552264321817802
},
{
"x": 2.4464370134331435,
"y": 6.947890317145862,
"heading": 0.07108140123042413,
"angularVelocity": -2.016243942366481,
"velocityX": 1.5497447988557767,
"velocityY": 0.27526645708275965,
"timestamp": 0.5899280841931415
},
{
"x": 2.4821822846008574,
"y": 6.954062116580002,
"heading": 0.02387349227336643,
"angularVelocity": -1.3603937052219282,
"velocityX": 1.0300740482329511,
"velocityY": 0.17785318785745177,
"timestamp": 0.6246297362045027
},
{
"x": 2.5,
"y": 6.957088470458984,
"heading": 2.0093661788817544e-33,
"angularVelocity": -0.6879641426163315,
"velocityX": 0.5134543852064684,
"velocityY": 0.08721065723302289,
"timestamp": 0.6593313882158639
},
{
"x": 2.5,
"y": 6.957088470458984,
"heading": 0,
"angularVelocity": -8.025462815650884e-32,
"velocityX": -3.4298034808089893e-33,
"x": 0.8022597960341636,
"y": 6.587072803769289,
"heading": 0.9986739281683281,
"angularVelocity": -0.5541098437511959,
"velocityX": 0.3283085234375779,
"velocityY": -0.011828671217327015,
"timestamp": 0.07458101006095233
},
{
"x": 0.8519509596093587,
"y": 6.58624052081795,
"heading": 0.92130341357734,
"angularVelocity": -1.0374023431403834,
"velocityX": 0.6662709922349006,
"velocityY": -0.011159448640586789,
"timestamp": 0.14916202012190466
},
{
"x": 0.9274840945472737,
"y": 6.586388414118182,
"heading": 0.8127223882915726,
"angularVelocity": -1.455880326601429,
"velocityX": 1.0127663178090307,
"velocityY": 0.001982988700662192,
"timestamp": 0.223743030182857
},
{
"x": 1.0299326460915046,
"y": 6.587708067588331,
"heading": 0.6829443155359307,
"angularVelocity": -1.7400954029669882,
"velocityX": 1.3736546536510383,
"velocityY": 0.017694228987703408,
"timestamp": 0.2983240402438093
},
{
"x": 1.1563896366352349,
"y": 6.592337580333048,
"heading": 0.5969389995681239,
"angularVelocity": -1.1531798228204053,
"velocityX": 1.6955655392755504,
"velocityY": 0.062073612852970986,
"timestamp": 0.3729050503047616
},
{
"x": 1.303789514545485,
"y": 6.601009577302425,
"heading": 0.5715164500982508,
"angularVelocity": -0.3408716166382244,
"velocityX": 1.9763727762570436,
"velocityY": 0.1162762070688939,
"timestamp": 0.4474860603657139
},
{
"x": 1.4600489951884137,
"y": 6.6056939320175365,
"heading": 0.5715163560688652,
"angularVelocity": -0.0000012607685095724167,
"velocityX": 2.095164446220536,
"velocityY": 0.06280894709532578,
"timestamp": 0.5220670704266662
},
{
"x": 1.6163084771514713,
"y": 6.610378242604074,
"heading": 0.5715162620402611,
"angularVelocity": -0.000001260758262137434,
"velocityX": 2.095164463921114,
"velocityY": 0.0628083554069323,
"timestamp": 0.5966480804876185
},
{
"x": 1.7725679591142018,
"y": 6.6150625531994836,
"heading": 0.5715161680117671,
"angularVelocity": -0.0000012607567828315742,
"velocityX": 2.095164463916719,
"velocityY": 0.06280835552621343,
"timestamp": 0.6712290905485708
},
{
"x": 1.9288274410769612,
"y": 6.619746863793874,
"heading": 0.5715160739832708,
"angularVelocity": -0.0000012607568122906995,
"velocityX": 2.0951644639171065,
"velocityY": 0.06280835551253054,
"timestamp": 0.7458101006095231
},
{
"x": 2.085086923039661,
"y": 6.624431174390149,
"heading": 0.5715159799547684,
"angularVelocity": -0.0000012607568901512097,
"velocityX": 2.09516446391631,
"velocityY": 0.06280835553779388,
"timestamp": 0.8203911106704754
},
{
"x": 2.241346405003104,
"y": 6.629115484970691,
"heading": 0.5715158859260843,
"angularVelocity": -0.0000012607593264970524,
"velocityX": 2.0951644639262916,
"velocityY": 0.06280835532631046,
"timestamp": 0.8949721207314277
},
{
"x": 2.397605884569563,
"y": 6.633799875776661,
"heading": 0.5715157918938158,
"angularVelocity": -0.0000012608069432354713,
"velocityX": 2.095164431787018,
"velocityY": 0.06280943101139673,
"timestamp": 0.96955313079238
},
{
"x": 2.541564258519034,
"y": 6.643991369670441,
"heading": 0.5358742044161485,
"angularVelocity": -0.4778909195321637,
"velocityX": 1.9302282689900117,
"velocityY": 0.1366499848331686,
"timestamp": 1.0441341408533324
},
{
"x": 2.6647430298386063,
"y": 6.651108311020372,
"heading": 0.4363244672087119,
"angularVelocity": -1.3347866585073835,
"velocityX": 1.6516103927652543,
"velocityY": 0.09542564982805292,
"timestamp": 1.1187151509142848
},
{
"x": 2.765146548502248,
"y": 6.655141686978524,
"heading": 0.28217231220283606,
"angularVelocity": -2.0669089206452895,
"velocityX": 1.3462343642383414,
"velocityY": 0.054080468404030795,
"timestamp": 1.193296160975237
},
{
"x": 2.838497759398012,
"y": 6.6577675266394865,
"heading": 0.14782655645686552,
"angularVelocity": -1.8013399877003722,
"velocityX": 0.9835105589992653,
"velocityY": 0.03520788547662426,
"timestamp": 1.2678771710361894
},
{
"x": 2.88643730414052,
"y": 6.659290340099078,
"heading": 0.050922701669744434,
"angularVelocity": -1.2993100349254527,
"velocityX": 0.6427848684717067,
"velocityY": 0.020418246660172383,
"timestamp": 1.3424581810971417
},
{
"x": 2.9100513458251953,
"y": 6.66,
"heading": -9.944840194397303e-31,
"angularVelocity": -0.6827837492158759,
"velocityX": 0.3166227122075712,
"velocityY": 0.00951528948644474,
"timestamp": 1.417039191158094
},
{
"x": 2.9100513458251953,
"y": 6.66,
"heading": -9.944840194397303e-31,
"angularVelocity": 0,
"velocityX": -3.154930727150579e-32,
"velocityY": 0,
"timestamp": 0.6940330402272251
"timestamp": 1.4916202012190463
}
]
}
Loading

0 comments on commit fedc2cd

Please sign in to comment.