Skip to content

Commit

Permalink
FIX
Browse files Browse the repository at this point in the history
  • Loading branch information
@amb2127
amb2127 committed Apr 6, 2024
1 parent 4162a9b commit 2fba208
Show file tree
Hide file tree
Showing 16 changed files with 8,801 additions and 4,708 deletions.
4,743 changes: 3,152 additions & 1,591 deletions FRC-2024.chor
View file

Large diffs are not rendered by default.

572 changes: 572 additions & 0 deletions src/main/deploy/choreo/4_far_source_blue.1.traj
View file

Large diffs are not rendered by default.

374 changes: 374 additions & 0 deletions src/main/deploy/choreo/4_far_source_blue.2.traj
View file
Original file line number Diff line number Diff line change
@@ -0,0 +1,374 @@
{
"samples": [
{
"x": 5.480079650878906,
"y": 1.6037307977676392,
"heading": -0.5611634369883582,
"angularVelocity": 5.5883317097663074e-27,
"velocityX": -9.516970360076388e-26,
"velocityY": 4.1071640182988243e-25,
"timestamp": 0
},
{
"x": 5.501180656026603,
"y": 1.6079494765220046,
"heading": -0.5426133301280462,
"angularVelocity": 0.28120068070336074,
"velocityX": 0.3198696943224927,
"velocityY": 0.06395086272707531,
"timestamp": 0.06596750339975355
},
{
"x": 5.543402213275228,
"y": 1.616710637549217,
"heading": -0.5064033684852626,
"angularVelocity": 0.5489060488367493,
"velocityX": 0.6400357004989004,
"velocityY": 0.13281025619722311,
"timestamp": 0.1319350067995071
},
{
"x": 5.606755786114241,
"y": 1.6304207307228014,
"heading": -0.45365316967848945,
"angularVelocity": 0.7996391569817989,
"velocityX": 0.9603754814715291,
"velocityY": 0.20783101477257854,
"timestamp": 0.19790251019926064
},
{
"x": 5.691235760700821,
"y": 1.649608386296175,
"heading": -0.38584761808619966,
"angularVelocity": 1.027862933987325,
"velocityX": 1.2806301623186087,
"velocityY": 0.29086526826851844,
"timestamp": 0.2638700135990142
},
{
"x": 5.796801268613493,
"y": 1.6749782196964749,
"heading": -0.3050781224109858,
"angularVelocity": 1.2243830903492292,
"velocityX": 1.600265319621979,
"velocityY": 0.3845807722411745,
"timestamp": 0.32983751699876773
},
{
"x": 5.923331159879221,
"y": 1.7074909346038172,
"heading": -0.21443645344970577,
"angularVelocity": 1.3740351580687271,
"velocityX": 1.9180639670259303,
"velocityY": 0.4928595631445961,
"timestamp": 0.3958050203985213
},
{
"x": 6.070502720409989,
"y": 1.7484976572379494,
"heading": -0.11865398969801891,
"angularVelocity": 1.4519643584396176,
"velocityX": 2.2309705983403476,
"velocityY": 0.6216200480657448,
"timestamp": 0.4617725237982748
},
{
"x": 6.23781946091035,
"y": 1.7992614372197573,
"heading": -0.022108267996246066,
"angularVelocity": 1.4635345696913722,
"velocityX": 2.536350958841735,
"velocityY": 0.7695270756903849,
"timestamp": 0.5277400271980284
},
{
"x": 6.425139284972961,
"y": 1.8600733561212284,
"heading": 0.07427302250091423,
"angularVelocity": 1.4610419605105138,
"velocityX": 2.839577282885476,
"velocityY": 0.9218466027577161,
"timestamp": 0.5937075305977819
},
{
"x": 6.632011075085416,
"y": 1.9317455116730187,
"heading": 0.16782665114800227,
"angularVelocity": 1.4181774938512701,
"velocityX": 3.135965126023358,
"velocityY": 1.0864767022857753,
"timestamp": 0.6596750339975355
},
{
"x": 6.838668517777772,
"y": 2.0170865471694617,
"heading": 0.19569466452281098,
"angularVelocity": 0.42245063006147854,
"velocityX": 3.132715837979201,
"velocityY": 1.293682966585659,
"timestamp": 0.725642537397289
},
{
"x": 7.024289013016697,
"y": 2.0953821886793,
"heading": 0.21443035355172568,
"angularVelocity": 0.2840139169035859,
"velocityX": 2.8138171929001174,
"velocityY": 1.1868819869592127,
"timestamp": 0.7916100407970426
},
{
"x": 7.1891450125782885,
"y": 2.165535097004884,
"heading": 0.22736817680895074,
"angularVelocity": 0.19612419131316364,
"velocityX": 2.4990486385787185,
"velocityY": 1.0634464654584108,
"timestamp": 0.8575775441967961
},
{
"x": 7.333346195912579,
"y": 2.2272010214783635,
"heading": 0.23555174589535685,
"angularVelocity": 0.12405455208475627,
"velocityX": 2.18594271273921,
"velocityY": 0.9347924553062558,
"timestamp": 0.9235450475965497
},
{
"x": 7.456950410814736,
"y": 2.280211885578687,
"heading": 0.23949189623354125,
"angularVelocity": 0.05972865630987483,
"velocityX": 1.873713700412948,
"velocityY": 0.8035905766978154,
"timestamp": 0.9895125509963032
},
{
"x": 7.559993267059326,
"y": 2.32446813583374,
"heading": 0.23949189623354125,
"angularVelocity": 3.404544943561017e-28,
"velocityX": 1.5620244959122553,
"velocityY": 0.6708795690942881,
"timestamp": 1.0554800543960567
},
{
"x": 7.633919096215732,
"y": 2.358822463704135,
"heading": 0.23949189623354125,
"angularVelocity": 8.473077779411904e-29,
"velocityX": 1.4167938220878702,
"velocityY": 0.6584031595476463,
"timestamp": 1.1076583092725958
},
{
"x": 7.695071822897778,
"y": 2.387433739559729,
"heading": 0.23949189623354125,
"angularVelocity": -6.49056904925108e-31,
"velocityX": 1.1719963963291269,
"velocityY": 0.548337155454748,
"timestamp": 1.1598365641491348
},
{
"x": 7.743451441693415,
"y": 2.4103019563450614,
"heading": 0.23949189623354125,
"angularVelocity": 1.1872347419884527e-28,
"velocityX": 0.9271988668480721,
"velocityY": 0.43827101614344843,
"timestamp": 1.2120148190256739
},
{
"x": 7.7790579508517474,
"y": 2.4274271115901564,
"heading": 0.23949189623354125,
"angularVelocity": 1.3938269473434321e-28,
"velocityX": 0.6824013038110015,
"velocityY": 0.32820482949488367,
"timestamp": 1.264193073902213
},
{
"x": 7.801891349534686,
"y": 2.438809203976939,
"heading": 0.23949189623354125,
"angularVelocity": 8.528138194563478e-29,
"velocityX": 0.43760372471187486,
"velocityY": 0.21813861758531802,
"timestamp": 1.316371328778752
},
{
"x": 7.811951637268066,
"y": 2.444448232650757,
"heading": 0.23949189623354125,
"angularVelocity": 1.4347571241900606e-29,
"velocityX": 0.19280613652534104,
"velocityY": 0.1080723892962794,
"timestamp": 1.368549583655291
},
{
"x": 7.797275078555593,
"y": 2.4395631129751245,
"heading": 0.23725974335537323,
"angularVelocity": -0.02785049230691545,
"velocityX": -0.18311890261262675,
"velocityY": -0.060951464962481924,
"timestamp": 1.4486972827899933
},
{
"x": 7.752457080240041,
"y": 2.4211599334630622,
"heading": 0.2326711590243989,
"angularVelocity": -0.057251603982572626,
"velocityX": -0.5591925756998709,
"velocityY": -0.22961581818003962,
"timestamp": 1.5288449819246956
},
{
"x": 7.677482375067664,
"y": 2.3892759311131617,
"heading": 0.2255657129261794,
"angularVelocity": -0.08865439900249006,
"velocityX": -0.9354567377707068,
"velocityY": -0.39781556668661766,
"timestamp": 1.608992681059398
},
{
"x": 7.572330694688685,
"y": 2.3439610927586982,
"heading": 0.21572835841721802,
"angularVelocity": -0.12274032336758603,
"velocityX": -1.3119737873229849,
"velocityY": -0.5653916312470079,
"timestamp": 1.6891403801941003
},
{
"x": 7.436973838148882,
"y": 2.285286054165389,
"heading": 0.20285581159356889,
"angularVelocity": -0.1606103102475162,
"velocityX": -1.6888426991810623,
"velocityY": -0.7320863758633294,
"timestamp": 1.7692880793288026
},
{
"x": 7.271369904953896,
"y": 2.2133582195065777,
"heading": 0.18648820233524804,
"angularVelocity": -0.2042180803071106,
"velocityX": -2.066234402021443,
"velocityY": -0.8974410424174952,
"timestamp": 1.849435778463505
},
{
"x": 7.075450211246154,
"y": 2.1283605462497714,
"heading": 0.16584551565172756,
"angularVelocity": -0.25755806974354645,
"velocityX": -2.444483070917154,
"velocityY": -1.060512955137396,
"timestamp": 1.9295834775982073
},
{
"x": 6.849082294590654,
"y": 2.0306743471268662,
"heading": 0.13931409836248118,
"angularVelocity": -0.3310315526919314,
"velocityX": -2.8243844689171693,
"velocityY": -1.2188272424230964,
"timestamp": 2.0097311767329096
},
{
"x": 6.591922469650067,
"y": 1.9215800047587555,
"heading": 0.101554583624829,
"angularVelocity": -0.47112412639807133,
"velocityX": -3.2085740166836763,
"velocityY": -1.3611662411513301,
"timestamp": 2.089878875867612
},
{
"x": 6.347819889299513,
"y": 1.8365513151345616,
"heading": 0.006182881277802801,
"angularVelocity": -1.18994934822442,
"velocityX": -3.0456592389545176,
"velocityY": -1.0608999452534225,
"timestamp": 2.170026575002314
},
{
"x": 6.132832068429533,
"y": 1.7670035230290484,
"heading": -0.09564125612656244,
"angularVelocity": -1.2704561516261565,
"velocityX": -2.682395417348837,
"velocityY": -0.8677453358782722,
"timestamp": 2.2501742741370165
},
{
"x": 5.947424627612842,
"y": 1.712150194043402,
"heading": -0.20037657079026824,
"angularVelocity": -1.306778807058196,
"velocityX": -2.3133220643686903,
"velocityY": -0.6844030406095064,
"timestamp": 2.330321973271719
},
{
"x": 5.791821455661515,
"y": 1.671558643765041,
"heading": -0.3063000326526817,
"angularVelocity": -1.3216032775237894,
"velocityX": -1.9414552586195613,
"velocityY": -0.506459333413174,
"timestamp": 2.410469672406421
},
{
"x": 5.667089199131936,
"y": 1.642199915413263,
"heading": -0.40143703197522407,
"angularVelocity": -1.1870209669106984,
"velocityX": -1.556279941610611,
"velocityY": -0.3663078125603518,
"timestamp": 2.4906173715411235
},
{
"x": 5.573535081322989,
"y": 1.6220106678585027,
"heading": -0.47850962719560064,
"angularVelocity": -0.9616320375066831,
"velocityX": -1.1672714103958488,
"velocityY": -0.2519005258133305,
"timestamp": 2.570765070675826
},
{
"x": 5.5112106151656315,
"y": 1.60954285985524,
"heading": -0.5328254735761668,
"angularVelocity": -0.6776968892054982,
"velocityX": -0.7776201541682422,
"velocityY": -0.1555603983379281,
"timestamp": 2.650912769810528
},
{
"x": 5.480079650878906,
"y": 1.6037307977676392,
"heading": -0.5611634369883582,
"angularVelocity": -0.353571764606298,
"velocityX": -0.38841993747573544,
"velocityY": -0.07251689256646873,
"timestamp": 2.7310604689452305
},
{
"x": 5.480079650878906,
"y": 1.6037307977676392,
"heading": -0.5611634369883582,
"angularVelocity": -1.8008718051619545e-27,
"velocityX": -2.443493470738108e-27,
"velocityY": -7.38291274215397e-27,
"timestamp": 2.811208168079933
}
],
"eventMarkers": []
}
Loading

0 comments on commit 2fba208

Please sign in to comment.