Skip to content

Commit

Permalink
Change Drive subsystem
Browse files Browse the repository at this point in the history 
- move control loop into IO implementation
- include timestamp queue for future
- added kraken implementation with FOC
  • Loading branch information
@suryatho
suryatho committed Jan 17, 2024
1 parent d63fad0 commit 93bb7b0
Show file tree
Hide file tree
Showing 23 changed files with 10,910 additions and 601 deletions.
2,919 changes: 2,919 additions & 0 deletions src/main/Potential Autos.chor
View file

Large diffs are not rendered by default.

2,802 changes: 2,802 additions & 0 deletions src/main/Test.chor
View file

Large diffs are not rendered by default.

490 changes: 490 additions & 0 deletions src/main/deploy/choreo/3Spike.traj
View file

Large diffs are not rendered by default.

1,759 changes: 1,759 additions & 0 deletions src/main/deploy/choreo/6Note.traj
View file

Large diffs are not rendered by default.

796 changes: 796 additions & 0 deletions src/main/deploy/choreo/FiveNoteCitrus.traj
View file

Large diffs are not rendered by default.

283 changes: 283 additions & 0 deletions src/main/deploy/choreo/New Path.traj
View file
Original file line number Diff line number Diff line change
@@ -0,0 +1,283 @@
{
"samples": [
{
"x": 1.4851783514022827,
"y": 7.326318264007568,
"heading": 0,
"angularVelocity": 0,
"velocityX": 0,
"velocityY": 0,
"timestamp": 0
},
{
"x": 1.566665314770093,
"y": 7.326318268482221,
"heading": -9.745639154608945e-23,
"angularVelocity": -8.704126162754158e-22,
"velocityX": 0.7277847634744247,
"velocityY": 3.996448202047959e-8,
"timestamp": 0.11196574517278132
},
{
"x": 1.7296392389410207,
"y": 7.326318277431527,
"heading": -3.4658654410217392e-22,
"angularVelocity": -2.2250569735274297e-21,
"velocityX": 1.4555695040427974,
"velocityY": 7.992896278313055e-8,
"timestamp": 0.22393149034556264
},
{
"x": 1.9741001187856775,
"y": 7.326318290855485,
"heading": -8.24362198504553e-22,
"angularVelocity": -4.267159205128636e-21,
"velocityX": 2.1833541987990532,
"velocityY": 1.1989344103012352e-7,
"timestamp": 0.33589723551834394
},
{
"x": 2.3000479389158897,
"y": 7.326318308754096,
"heading": -1.7621745704477776e-21,
"angularVelocity": -8.375886381665278e-21,
"velocityX": 2.9111387561188593,
"velocityY": 1.5985791173013713e-7,
"timestamp": 0.4478629806911253
},
{
"x": 2.6359451684196418,
"y": 7.326318327199053,
"heading": 5.860691675515718e-19,
"angularVelocity": 5.250099783101951e-18,
"velocityX": 2.999999946281858,
"velocityY": 1.6473750198101658e-7,
"timestamp": 0.5598287258639066
},
{
"x": 2.9718423979233948,
"y": 7.326318345644011,
"heading": 4.8428473870582435e-18,
"angularVelocity": 3.801857621890219e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 0.671794471036688
},
{
"x": 3.307739627427147,
"y": 7.3263183640889675,
"heading": 1.0521971096433735e-17,
"angularVelocity": 5.072197480886782e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101613e-7,
"timestamp": 0.7837602162094693
},
{
"x": 3.6436368569308994,
"y": 7.326318382533925,
"heading": 1.4717398190746304e-17,
"angularVelocity": 3.747063076821502e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 0.8957259613822507
},
{
"x": 3.979534086434652,
"y": 7.326318400978883,
"heading": 1.7426356992707997e-17,
"angularVelocity": 2.4194532030809352e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 1.007691706555032
},
{
"x": 4.315431315938405,
"y": 7.326318419423839,
"heading": 1.8985412935500457e-17,
"angularVelocity": 1.3924401153114026e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 1.1196574517278133
},
{
"x": 4.651328545442158,
"y": 7.326318437868797,
"heading": 2.022868920510175e-17,
"angularVelocity": 1.1104077197839936e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 1.2316231969005946
},
{
"x": 4.98722577494591,
"y": 7.3263184563137544,
"heading": 2.188100699427991e-17,
"angularVelocity": 1.4757350915348522e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 1.343588942073376
},
{
"x": 5.323123004449662,
"y": 7.326318474758711,
"heading": 2.3719859301334404e-17,
"angularVelocity": 1.6423347194890602e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 1.4555546872461573
},
{
"x": 5.659020233953415,
"y": 7.326318493203669,
"heading": 2.5354180700870405e-17,
"angularVelocity": 1.4596619698171647e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 1.5675204324189387
},
{
"x": 5.994917463457167,
"y": 7.326318511648626,
"heading": 2.6401814540471825e-17,
"angularVelocity": 9.356735339113599e-18,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 1.67948617759172
},
{
"x": 6.330814692960919,
"y": 7.326318530093584,
"heading": 2.6961840683369917e-17,
"angularVelocity": 5.001763244165286e-18,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 1.7914519227645014
},
{
"x": 6.666711922464672,
"y": 7.3263185485385405,
"heading": 2.746703941908865e-17,
"angularVelocity": 4.512083019401423e-18,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 1.9034176679372827
},
{
"x": 7.002609151968424,
"y": 7.326318566983498,
"heading": 2.75257745202433e-17,
"angularVelocity": 5.245810017426919e-19,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 2.015383413110064
},
{
"x": 7.338506381472176,
"y": 7.326318585428456,
"heading": 2.6894889559197837e-17,
"angularVelocity": -5.634624707407713e-18,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 2.127349158282845
},
{
"x": 7.674403610975929,
"y": 7.326318603873412,
"heading": 2.614291653422174e-17,
"angularVelocity": -6.716098963685828e-18,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 2.2393149034556266
},
{
"x": 8.010300840479681,
"y": 7.32631862231837,
"heading": 2.4766232846828968e-17,
"angularVelocity": -1.2295579197538016e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 2.351280648628408
},
{
"x": 8.346198069983435,
"y": 7.326318640763327,
"heading": 2.2029876482173888e-17,
"angularVelocity": -2.4439227918755626e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 2.4632463938011893
},
{
"x": 8.68209529948719,
"y": 7.326318659208284,
"heading": 1.6814351481469152e-17,
"angularVelocity": -4.6581434349974976e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101613e-7,
"timestamp": 2.5752121389739706
},
{
"x": 9.017992528990941,
"y": 7.326318677653242,
"heading": 6.264884173064017e-18,
"angularVelocity": -9.42204897841851e-17,
"velocityX": 2.9999999462818616,
"velocityY": 1.6473750198101616e-7,
"timestamp": 2.687177884146752
},
{
"x": 9.353889758494695,
"y": 7.326318696098199,
"heading": -5.6652372475915536e-21,
"angularVelocity": -5.600417688760007e-17,
"velocityX": 2.999999946281858,
"velocityY": 1.6473750198101658e-7,
"timestamp": 2.7991436293195333
},
{
"x": 9.679837578624907,
"y": 7.32631871399681,
"heading": -2.7181194656762927e-21,
"angularVelocity": 2.6321601978014413e-20,
"velocityX": 2.9111387561188593,
"velocityY": 1.5985791173013718e-7,
"timestamp": 2.9111093744923147
},
{
"x": 9.924298458469563,
"y": 7.326318727420768,
"heading": -1.1801505322960497e-21,
"angularVelocity": 1.3736066636473078e-20,
"velocityX": 2.1833541987990532,
"velocityY": 1.1989344103012357e-7,
"timestamp": 3.023075119665096
},
{
"x": 10.08727238264049,
"y": 7.326318736370074,
"heading": -3.536469486075474e-22,
"angularVelocity": 7.381753952033097e-21,
"velocityX": 1.4555695040427974,
"velocityY": 7.992896278313059e-8,
"timestamp": 3.1350408648378774
},
{
"x": 10.1687593460083,
"y": 7.326318740844727,
"heading": 0,
"angularVelocity": 3.1585280732860345e-21,
"velocityX": 0.7277847634744247,
"velocityY": 3.996448202047962e-8,
"timestamp": 3.2470066100106587
},
{
"x": 10.1687593460083,
"y": 7.326318740844727,
"heading": 0,
"angularVelocity": 0,
"velocityX": 4.0858250360262775e-40,
"velocityY": 0,
"timestamp": 3.35897235518344
}
]
}
Loading

0 comments on commit 93bb7b0

Please sign in to comment.