Skip to content

Commit

Permalink
Week0 (#142)
Browse files Browse the repository at this point in the history 
* autochanges

* changed pick up far

* added a flap deploy command upon teleop init and changed speed factor on left joystick

* schedule command group on match mode start

* moved reposition speed to constants

* changed constraint values

* auto changes, path changes, named command changed to seperate pick up and arm up

* mirrored changes to on red far to blue and added stop point on near pick up for added consistancy

* renamedCommand intake piece and raise to intake piece because no longer raises

---------

Co-authored-by: DylanTaylor29 <[email protected]>
Co-authored-by: Nate Laverdure <[email protected]>
  • Loading branch information
@bot3O3 @DylanTaylor29 @nlaverdure
3 people authored Feb 28, 2024
1 parent 1bcaaea commit d2b7085
Show file tree
Hide file tree
Showing 33 changed files with 13,121 additions and 9,766 deletions.
432 changes: 351 additions & 81 deletions src/main/deploy/choreo/B-driveFwd2m.1.traj
View file

Large diffs are not rendered by default.

432 changes: 351 additions & 81 deletions src/main/deploy/choreo/B-driveFwd2m.traj
View file

Large diffs are not rendered by default.

247 changes: 247 additions & 0 deletions src/main/deploy/choreo/B_FarPiece1MK2.1.traj
View file
Original file line number Diff line number Diff line change
@@ -0,0 +1,247 @@
{
"samples": [
{
"x": 1.77,
"y": 7.9,
"heading": -1.571,
"angularVelocity": -4.502777633455683e-29,
"velocityX": -2.8428682367219836e-22,
"velocityY": -2.7501186280904204e-21,
"timestamp": 0
},
{
"x": 1.7795079832719092,
"y": 7.899026735204308,
"heading": -1.571,
"angularVelocity": 2.2442250118494674e-28,
"velocityX": 0.28083218410064814,
"velocityY": -0.02874679839730577,
"timestamp": 0.03385645880424314
},
{
"x": 1.7985239495651593,
"y": 7.897080205638551,
"heading": -1.571,
"angularVelocity": -1.4597593703783005e-28,
"velocityX": 0.5616643608000584,
"velocityY": -0.05749359603699967,
"timestamp": 0.06771291760848629
},
{
"x": 1.8270478985835694,
"y": 7.894160411333058,
"heading": -1.571,
"angularVelocity": 2.0955353143994283e-28,
"velocityX": 0.8424965287525504,
"velocityY": -0.0862403927813339,
"timestamp": 0.10156937641272942
},
{
"x": 1.8650798299718314,
"y": 7.890267352324334,
"heading": -1.571,
"angularVelocity": -2.8977872868904444e-28,
"velocityX": 1.1233286862087388,
"velocityY": -0.11498718845123643,
"timestamp": 0.13542583521697257
},
{
"x": 1.9126197432955534,
"y": 7.885401028656508,
"heading": -1.571,
"angularVelocity": 1.3802779997876164e-28,
"velocityX": 1.4041608308361102,
"velocityY": -0.14373398280794444,
"timestamp": 0.16928229402121572
},
{
"x": 1.969667638011868,
"y": 7.879561440385458,
"heading": -1.571,
"angularVelocity": 2.919267255677947e-29,
"velocityX": 1.684992959427457,
"velocityY": -0.17248077552315902,
"timestamp": 0.20313875282545887
},
{
"x": 2.03622351342267,
"y": 7.872748587582727,
"heading": -1.571,
"angularVelocity": 7.112090862798517e-29,
"velocityX": 1.9658250674010538,
"velocityY": -0.2012275661278816,
"timestamp": 0.23699521162970202
},
{
"x": 2.1122873685972796,
"y": 7.864962470342984,
"heading": -1.571,
"angularVelocity": 4.3219798795056843e-29,
"velocityX": 2.2466571478843105,
"velocityY": -0.2299743539186141,
"timestamp": 0.27085167043394515
},
{
"x": 2.1978592022326424,
"y": 7.856203088800681,
"heading": -1.571,
"angularVelocity": -3.44843002739284e-29,
"velocityX": 2.5274891898810785,
"velocityY": -0.25872113776975936,
"timestamp": 0.3047081292381883
},
{
"x": 2.292939012374285,
"y": 7.846470443154588,
"heading": -1.571,
"angularVelocity": 5.833306980197201e-29,
"velocityX": 2.8083211741480913,
"velocityY": -0.2874679157115213,
"timestamp": 0.33856458804243145
},
{
"x": 2.3975267957646387,
"y": 7.8357645337391775,
"heading": -1.571,
"angularVelocity": 1.561839230808609e-29,
"velocityX": 3.089153062198798,
"velocityY": -0.31621468380430645,
"timestamp": 0.3724210468466746
},
{
"x": 2.5116225458885735,
"y": 7.824085361220831,
"heading": -1.571,
"angularVelocity": 2.8895581941873034e-29,
"velocityX": 3.369984757816784,
"velocityY": -0.3449614321991266,
"timestamp": 0.40627750565091775
},
{
"x": 2.635226243200861,
"y": 7.811432927600528,
"heading": -1.571,
"angularVelocity": 1.3995144228785363e-29,
"velocityX": 3.6508158761365554,
"velocityY": -0.3737081215000466,
"timestamp": 0.4401339644551609
},
{
"x": 2.762637409669379,
"y": 7.7983907502572976,
"heading": -1.571,
"angularVelocity": -8.314733154355235e-28,
"velocityX": 3.763275043181629,
"velocityY": -0.3852197720565959,
"timestamp": 0.47399042325940405
},
{
"x": 2.89004846909155,
"y": 7.785347527201693,
"heading": -1.571,
"angularVelocity": 1.4403879365127324e-29,
"velocityX": 3.7632718814112684,
"velocityY": -0.3852506587004015,
"timestamp": 0.5078468820636471
},
{
"x": 3.016723155975342,
"y": 7.766447067260742,
"heading": -1.571,
"angularVelocity": 9.895674963850826e-30,
"velocityX": 3.741522042107885,
"velocityY": -0.5582527118446727,
"timestamp": 0.5417033408678903
},
{
"x": 3.2751685021997914,
"y": 7.68474149048493,
"heading": -1.571,
"angularVelocity": -4.23188915595325e-16,
"velocityX": 3.6069804986503287,
"velocityY": -1.1403200961702404,
"timestamp": 0.6133547807137965
},
{
"x": 3.531906038642613,
"y": 7.597818330864093,
"heading": -1.571,
"angularVelocity": 3.8070888243911377e-16,
"velocityX": 3.583145530571451,
"velocityY": -1.213139049372781,
"timestamp": 0.6850062205597027
},
{
"x": 3.7886435557380396,
"y": 7.510895114098561,
"heading": -1.571,
"angularVelocity": -9.775781289241169e-17,
"velocityX": 3.583145260550385,
"velocityY": -1.2131398469097145,
"timestamp": 0.756657660405609
},
{
"x": 4.0319226590039365,
"y": 7.428528491303723,
"heading": -1.571,
"angularVelocity": 7.765172723193242e-17,
"velocityX": 3.3953135315778273,
"velocityY": -1.1495459543018203,
"timestamp": 0.8283091002515153
},
{
"x": 4.234655265535747,
"y": 7.359889632041882,
"heading": -1.571,
"angularVelocity": 7.319843833796333e-17,
"velocityX": 2.829428228767534,
"velocityY": -0.9579550586763032,
"timestamp": 0.8999605400974215
},
{
"x": 4.396841358029104,
"y": 7.304978542171781,
"heading": -1.571,
"angularVelocity": 1.0101536209754802e-16,
"velocityX": 2.263542684447898,
"velocityY": -0.7663640812833484,
"timestamp": 0.9716119799433278
},
{
"x": 4.518480930715831,
"y": 7.26379522364634,
"heading": -1.571,
"angularVelocity": 1.1941974905254455e-16,
"velocityX": 1.69765705962518,
"velocityY": -0.5747730766345919,
"timestamp": 1.043263419789234
},
{
"x": 4.599573980711799,
"y": 7.236339677441761,
"heading": -1.571,
"angularVelocity": 1.0930025753416189e-16,
"velocityX": 1.1317713945509316,
"velocityY": -0.38318205835793806,
"timestamp": 1.1149148596351404
},
{
"x": 4.640120506286621,
"y": 7.222611904144287,
"heading": -1.571,
"angularVelocity": 5.1438092157822685e-18,
"velocityX": 0.5658857053257693,
"velocityY": -0.19159103190454757,
"timestamp": 1.1865662994810466
},
{
"x": 4.640120506286621,
"y": 7.222611904144287,
"heading": -1.571,
"angularVelocity": 1.0709865073478266e-32,
"velocityX": 8.837591240141188e-22,
"velocityY": 1.992399682179807e-21,
"timestamp": 1.258217739326953
}
]
}
Loading

0 comments on commit d2b7085

Please sign in to comment.