Skip to content

Commit

Permalink
add 2 piece auto and 2 piece speaker auto
Browse files Browse the repository at this point in the history
  • Loading branch information
@Lu-han-wang
Lu-han-wang committed Mar 16, 2024
1 parent 0bd4159 commit 0bb1128
Show file tree
Hide file tree
Showing 19 changed files with 2,567 additions and 1,496 deletions.
1,293 changes: 876 additions & 417 deletions example.chor
View file

Large diffs are not rendered by default.

122 changes: 122 additions & 0 deletions src/main/deploy/choreo/Amp Path.1.traj
View file
Original file line number Diff line number Diff line change
@@ -0,0 +1,122 @@
{
"samples": [
{
"x": 0.34882909059524536,
"y": 6.909913063049316,
"heading": -1.571,
"angularVelocity": -3.922663902728468e-28,
"velocityX": -1.167698209035646e-22,
"velocityY": -6.229927740670887e-23,
"timestamp": 0
},
{
"x": 0.3897355783743341,
"y": 6.931737968062141,
"heading": -1.571,
"angularVelocity": 1.208281885385905e-16,
"velocityX": 0.42258212120122357,
"velocityY": 0.22546092700848266,
"timestamp": 0.09680127418265765
},
{
"x": 0.471548552905651,
"y": 6.975387777539927,
"heading": -1.571,
"angularVelocity": 1.6283037922319714e-16,
"velocityX": 0.8451642317945236,
"velocityY": 0.45092184835730265,
"timestamp": 0.1936025483653153
},
{
"x": 0.5942680125755582,
"y": 7.040862490621748,
"heading": -1.571,
"angularVelocity": 1.191758039454532e-16,
"velocityX": 1.26774632571823,
"velocityY": 0.6763827608123671,
"timestamp": 0.2904038225479729
},
{
"x": 0.7578939544795075,
"y": 7.128162105757935,
"heading": -1.571,
"angularVelocity": 2.639204484888881e-16,
"velocityX": 1.6903283896366685,
"velocityY": 0.9018436572586722,
"timestamp": 0.3872050967306306
},
{
"x": 0.9624263718402206,
"y": 7.237286619332597,
"heading": -1.571,
"angularVelocity": 3.057960398887192e-16,
"velocityX": 2.1129103835428222,
"velocityY": 1.1273045163512094,
"timestamp": 0.48400637091328824
},
{
"x": 1.2078652307713211,
"y": 7.368236013266279,
"heading": -1.571,
"angularVelocity": 3.06557006671897e-16,
"velocityX": 2.5354920273877144,
"velocityY": 1.3527651886749916,
"timestamp": 0.5808076450959458
},
{
"x": 1.4123976481320342,
"y": 7.477360526840941,
"heading": -1.571,
"angularVelocity": 2.616471919352985e-16,
"velocityX": 2.1129103835428222,
"velocityY": 1.1273045163512092,
"timestamp": 0.6776089192786034
},
{
"x": 1.5760235900359836,
"y": 7.564660141977128,
"heading": -1.571,
"angularVelocity": 1.8033615322975308e-16,
"velocityX": 1.6903283896366683,
"velocityY": 0.9018436572586722,
"timestamp": 0.774410193461261
},
{
"x": 1.6987430497058906,
"y": 7.630134855058949,
"heading": -1.571,
"angularVelocity": 1.9195672834654785e-16,
"velocityX": 1.2677463257182298,
"velocityY": 0.676382760812367,
"timestamp": 0.8712114676439187
},
{
"x": 1.7805560242372076,
"y": 7.673784664536735,
"heading": -1.571,
"angularVelocity": 1.0539129035996969e-16,
"velocityX": 0.8451642317945235,
"velocityY": 0.45092184835730265,
"timestamp": 0.9680127418265763
},
{
"x": 1.8214625120162964,
"y": 7.69560956954956,
"heading": -1.571,
"angularVelocity": 5.922306019221969e-17,
"velocityX": 0.42258212120122357,
"velocityY": 0.22546092700848264,
"timestamp": 1.0648140160092339
},
{
"x": 1.8214625120162964,
"y": 7.69560956954956,
"heading": -1.571,
"angularVelocity": -1.4047196609476565e-22,
"velocityX": -2.7377630717039226e-22,
"velocityY": 3.502232220013514e-22,
"timestamp": 1.1616152901918915
}
],
"eventMarkers": []
}
194 changes: 194 additions & 0 deletions src/main/deploy/choreo/Amp Path.2.traj
View file
Original file line number Diff line number Diff line change
@@ -0,0 +1,194 @@
{
"samples": [
{
"x": 1.8214625120162964,
"y": 7.69560956954956,
"heading": -1.571,
"angularVelocity": -1.4047196609476565e-22,
"velocityX": -2.7377630717039226e-22,
"velocityY": 3.502232220013514e-22,
"timestamp": 0
},
{
"x": 1.8263885624163958,
"y": 7.685341541375445,
"heading": -1.5523107376554257,
"angularVelocity": 0.3601187319582724,
"velocityX": 0.0949188357967115,
"velocityY": -0.19785207236108446,
"timestamp": 0.0518975012572791
},
{
"x": 1.8362709900716396,
"y": 7.664850447178493,
"heading": -1.5146283537418697,
"angularVelocity": 0.7260924514794579,
"velocityX": 0.19042203219481108,
"velocityY": -0.3948377802501253,
"timestamp": 0.1037950025145582
},
{
"x": 1.8511345117224307,
"y": 7.634229827542471,
"heading": -1.4573389514829618,
"angularVelocity": 1.1038951947782367,
"velocityX": 0.2864014892953312,
"velocityY": -0.590021077974866,
"timestamp": 0.1556925037718373
},
{
"x": 1.8710360411604787,
"y": 7.5936213363446,
"heading": -1.379634269550574,
"angularVelocity": 1.4972721238961164,
"velocityX": 0.3834776040446946,
"velocityY": -0.7824748824911102,
"timestamp": 0.2075900050291164
},
{
"x": 1.8960972443627409,
"y": 7.543208270361837,
"heading": -1.280672280009594,
"angularVelocity": 1.9068738791561721,
"velocityX": 0.4828980701406524,
"velocityY": -0.9713967871563342,
"timestamp": 0.2594875062863955
},
{
"x": 1.9265261930761366,
"y": 7.483201806870977,
"heading": -1.1597803195315042,
"angularVelocity": 2.3294370162211497,
"velocityX": 0.5863278188008654,
"velocityY": -1.1562495695771775,
"timestamp": 0.3113850075436746
},
{
"x": 1.9626249773416764,
"y": 7.413817197534052,
"heading": -1.0166999176234586,
"angularVelocity": 2.7569805567079637,
"velocityX": 0.6955784650706432,
"velocityY": -1.3369547214413133,
"timestamp": 0.3632825088009537
},
{
"x": 2.0047793946685926,
"y": 7.3352272874667825,
"heading": -0.8518960043780762,
"angularVelocity": 3.175565475269718,
"velocityX": 0.8122629472648041,
"velocityY": -1.5143293639064417,
"timestamp": 0.4151800100582328
},
{
"x": 2.0534104244086793,
"y": 7.247456119131475,
"heading": -0.666981217294469,
"angularVelocity": 3.5630768843166822,
"velocityX": 0.9370591755275562,
"velocityY": -1.6912407381655292,
"timestamp": 0.4670775113155119
},
{
"x": 2.10877787049276,
"y": 7.150147915979358,
"heading": -0.4650939752067117,
"angularVelocity": 3.8901148840849182,
"velocityX": 1.0668615008957674,
"velocityY": -1.8750074819540388,
"timestamp": 0.518975012572791
},
{
"x": 2.1569053797928603,
"y": 7.061802623313555,
"heading": -0.280100951121351,
"angularVelocity": 3.564584413578364,
"velocityX": 0.9273569658298245,
"velocityY": -1.7023033966093224,
"timestamp": 0.5708725138300701
},
{
"x": 2.1994959672047143,
"y": 6.983964965728285,
"heading": -0.11065895835287402,
"angularVelocity": 3.264935472104471,
"velocityX": 0.8206673997792975,
"velocityY": -1.4998343985656317,
"timestamp": 0.6227700150873492
},
{
"x": 2.237004047724282,
"y": 6.916430811387477,
"heading": 0.04053318586314143,
"angularVelocity": 2.913283694844736,
"velocityX": 0.7227338428804729,
"velocityY": -1.301298765927304,
"timestamp": 0.6746675163446283
},
{
"x": 2.269495281442816,
"y": 6.858918658282111,
"heading": 0.17148583744958443,
"angularVelocity": 2.523293962405861,
"velocityX": 0.6260654738936422,
"velocityY": -1.1081873252481498,
"timestamp": 0.7265650176019074
},
{
"x": 2.2968652079461687,
"y": 6.811205436346894,
"heading": 0.28108581286356865,
"angularVelocity": 2.111854574089187,
"velocityX": 0.5273842832560975,
"velocityY": -0.919374165986924,
"timestamp": 0.7784625188591865
},
{
"x": 2.3189633401147964,
"y": 6.773138213551363,
"heading": 0.3688175541621904,
"angularVelocity": 1.690481028435189,
"velocityX": 0.42580339386818283,
"velocityY": -0.7335078158544751,
"timestamp": 0.8303600201164656
},
{
"x": 2.3356494769817644,
"y": 6.7446233485977665,
"heading": 0.4345194750870735,
"angularVelocity": 1.2659939174945882,
"velocityX": 0.32152100703746095,
"velocityY": -0.5494458165188988,
"timestamp": 0.8822575213737449
},
{
"x": 2.3468183245123964,
"y": 6.725613875161264,
"heading": 0.478214015763415,
"angularVelocity": 0.8419391997261695,
"velocityX": 0.21520973573010924,
"velocityY": -0.3662887995755887,
"timestamp": 0.934155022631024
},
{
"x": 2.3524093627929688,
"y": 6.716099262237549,
"heading": 0.5,
"angularVelocity": 0.4197886932664092,
"velocityX": 0.10773232130878599,
"velocityY": -0.1833347019261562,
"timestamp": 0.9860525238883031
},
{
"x": 2.3524093627929688,
"y": 6.716099262237549,
"heading": 0.5,
"angularVelocity": 1.27847157041286e-22,
"velocityX": 5.486884150990498e-22,
"velocityY": -1.2758696812798843e-22,
"timestamp": 1.0379500251455822
}
],
"eventMarkers": []
}
Loading

0 comments on commit 0bb1128

Please sign in to comment.