diff --git a/src/main/deploy/choreo/Red 4 to CWS.1.traj b/src/main/deploy/choreo/Red 4 to CWS.1.traj new file mode 100644 index 00000000..d0eabd38 --- /dev/null +++ b/src/main/deploy/choreo/Red 4 to CWS.1.traj @@ -0,0 +1,122 @@ +{ + "samples": [ + { + "x": 9.1292085647583, + "y": 7.463241577148437, + "heading": -1.667402920110202e-23, + "angularVelocity": -7.105893464585413e-24, + "velocityX": 1.9107951304231947e-24, + "velocityY": -3.9513703650294445e-24, + "timestamp": 0 + }, + { + "x": 9.202228802975283, + "y": 7.43643053208001, + "heading": -0.010601683346708838, + "angularVelocity": -0.12032963165578175, + "velocityX": 0.8287833243759717, + "velocityY": -0.30430669091732365, + "timestamp": 0.08810534197458779 + }, + { + "x": 9.348269051180246, + "y": 7.382807931423719, + "heading": -0.03184320758536198, + "angularVelocity": -0.24109235334197815, + "velocityX": 1.6575640583415123, + "velocityY": -0.6086191762555923, + "timestamp": 0.17621068394917558 + }, + { + "x": 9.567328874222518, + "y": 7.302373052328402, + "heading": -0.06379484985933483, + "angularVelocity": -0.362652724090086, + "velocityX": 2.4863398533252936, + "velocityY": -0.9129398659903866, + "timestamp": 0.26431602592376335 + }, + { + "x": 9.859407635240762, + "y": 7.195124920858945, + "heading": -0.10655016324134052, + "angularVelocity": -0.4852749268521946, + "velocityX": 3.315108419901344, + "velocityY": -1.2172716099370104, + "timestamp": 0.35242136789835116 + }, + { + "x": 10.192837587328619, + "y": 7.072651571321672, + "heading": -0.10655016599578679, + "angularVelocity": -3.126310170419999e-8, + "velocityX": 3.7844464888863056, + "velocityY": -1.3900785899292845, + "timestamp": 0.44052670987293896 + }, + { + "x": 10.52626753919339, + "y": 6.950178221176961, + "heading": -0.1065501687502156, + "angularVelocity": -3.126290359484911e-8, + "velocityX": 3.7844464863542937, + "velocityY": -1.3900785968237475, + "timestamp": 0.5286320518475267 + }, + { + "x": 10.859697491223413, + "y": 6.82770487148224, + "heading": -0.10655017150466216, + "angularVelocity": -3.126310516103417e-8, + "velocityX": 3.7844464882298987, + "velocityY": -1.390078591716332, + "timestamp": 0.6167373938221145 + }, + { + "x": 11.151767702106236, + "y": 6.720442093033459, + "heading": -0.1504495662331604, + "angularVelocity": -0.4982603068626659, + "velocityX": 3.315011375440373, + "velocityY": -1.2174378538785793, + "timestamp": 0.7048427357967022 + }, + { + "x": 11.37082008036848, + "y": 6.6399944366452095, + "heading": -0.1834043776397133, + "angularVelocity": -0.3740387434857022, + "velocityX": 2.486255354702837, + "velocityY": -0.9130848888987183, + "timestamp": 0.79294807777129 + }, + { + "x": 11.516854922707223, + "y": 6.586362464735785, + "heading": -0.20538061595377177, + "angularVelocity": -0.2494313945276675, + "velocityX": 1.657502701491852, + "velocityY": -0.6087255404433256, + "timestamp": 0.8810534197458777 + }, + { + "x": 11.589872360229492, + "y": 6.55954647064209, + "heading": -0.2163660265240023, + "angularVelocity": -0.1246849546693668, + "velocityX": 0.8287515363521442, + "velocityY": -0.3043628625995168, + "timestamp": 0.9691587617204654 + }, + { + "x": 11.589872360229492, + "y": 6.55954647064209, + "heading": -0.2163660265240023, + "angularVelocity": 1.5342116317474738e-23, + "velocityX": 3.420153298016769e-24, + "velocityY": -5.557275176460609e-24, + "timestamp": 1.0572641036950532 + } + ], + "eventMarkers": [] +} \ No newline at end of file diff --git a/src/main/deploy/choreo/Red 4 to CWS.traj b/src/main/deploy/choreo/Red 4 to CWS.traj new file mode 100644 index 00000000..d0eabd38 --- /dev/null +++ b/src/main/deploy/choreo/Red 4 to CWS.traj @@ -0,0 +1,122 @@ +{ + "samples": [ + { + "x": 9.1292085647583, + "y": 7.463241577148437, + "heading": -1.667402920110202e-23, + "angularVelocity": -7.105893464585413e-24, + "velocityX": 1.9107951304231947e-24, + "velocityY": -3.9513703650294445e-24, + "timestamp": 0 + }, + { + "x": 9.202228802975283, + "y": 7.43643053208001, + "heading": -0.010601683346708838, + "angularVelocity": -0.12032963165578175, + "velocityX": 0.8287833243759717, + "velocityY": -0.30430669091732365, + "timestamp": 0.08810534197458779 + }, + { + "x": 9.348269051180246, + "y": 7.382807931423719, + "heading": -0.03184320758536198, + "angularVelocity": -0.24109235334197815, + "velocityX": 1.6575640583415123, + "velocityY": -0.6086191762555923, + "timestamp": 0.17621068394917558 + }, + { + "x": 9.567328874222518, + "y": 7.302373052328402, + "heading": -0.06379484985933483, + "angularVelocity": -0.362652724090086, + "velocityX": 2.4863398533252936, + "velocityY": -0.9129398659903866, + "timestamp": 0.26431602592376335 + }, + { + "x": 9.859407635240762, + "y": 7.195124920858945, + "heading": -0.10655016324134052, + "angularVelocity": -0.4852749268521946, + "velocityX": 3.315108419901344, + "velocityY": -1.2172716099370104, + "timestamp": 0.35242136789835116 + }, + { + "x": 10.192837587328619, + "y": 7.072651571321672, + "heading": -0.10655016599578679, + "angularVelocity": -3.126310170419999e-8, + "velocityX": 3.7844464888863056, + "velocityY": -1.3900785899292845, + "timestamp": 0.44052670987293896 + }, + { + "x": 10.52626753919339, + "y": 6.950178221176961, + "heading": -0.1065501687502156, + "angularVelocity": -3.126290359484911e-8, + "velocityX": 3.7844464863542937, + "velocityY": -1.3900785968237475, + "timestamp": 0.5286320518475267 + }, + { + "x": 10.859697491223413, + "y": 6.82770487148224, + "heading": -0.10655017150466216, + "angularVelocity": -3.126310516103417e-8, + "velocityX": 3.7844464882298987, + "velocityY": -1.390078591716332, + "timestamp": 0.6167373938221145 + }, + { + "x": 11.151767702106236, + "y": 6.720442093033459, + "heading": -0.1504495662331604, + "angularVelocity": -0.4982603068626659, + "velocityX": 3.315011375440373, + "velocityY": -1.2174378538785793, + "timestamp": 0.7048427357967022 + }, + { + "x": 11.37082008036848, + "y": 6.6399944366452095, + "heading": -0.1834043776397133, + "angularVelocity": -0.3740387434857022, + "velocityX": 2.486255354702837, + "velocityY": -0.9130848888987183, + "timestamp": 0.79294807777129 + }, + { + "x": 11.516854922707223, + "y": 6.586362464735785, + "heading": -0.20538061595377177, + "angularVelocity": -0.2494313945276675, + "velocityX": 1.657502701491852, + "velocityY": -0.6087255404433256, + "timestamp": 0.8810534197458777 + }, + { + "x": 11.589872360229492, + "y": 6.55954647064209, + "heading": -0.2163660265240023, + "angularVelocity": -0.1246849546693668, + "velocityX": 0.8287515363521442, + "velocityY": -0.3043628625995168, + "timestamp": 0.9691587617204654 + }, + { + "x": 11.589872360229492, + "y": 6.55954647064209, + "heading": -0.2163660265240023, + "angularVelocity": 1.5342116317474738e-23, + "velocityX": 3.420153298016769e-24, + "velocityY": -5.557275176460609e-24, + "timestamp": 1.0572641036950532 + } + ], + "eventMarkers": [] +} \ No newline at end of file diff --git a/src/main/deploy/choreo/Red CWS to 5.1.traj b/src/main/deploy/choreo/Red CWS to 5.1.traj new file mode 100644 index 00000000..e5334c3c --- /dev/null +++ b/src/main/deploy/choreo/Red CWS to 5.1.traj @@ -0,0 +1,122 @@ +{ + "samples": [ + { + "x": 11.633423805236816, + "y": 6.701088905334473, + "heading": -0.23748596442563125, + "angularVelocity": 4.0633007276282394e-23, + "velocityX": 6.7184741034051145e-22, + "velocityY": 5.702159340164939e-22, + "timestamp": 0 + }, + { + "x": 11.558314016783294, + "y": 6.672811015849246, + "heading": -0.22610284681530854, + "angularVelocity": 0.1271903732506324, + "velocityX": -0.8392465364248116, + "velocityY": -0.31596575222103795, + "timestamp": 0.08949669160803514 + }, + { + "x": 11.40809470327327, + "y": 6.616254752098494, + "heading": -0.2032649088498646, + "angularVelocity": 0.25518192410358925, + "velocityX": -1.678490130479727, + "velocityY": -0.6319369234749451, + "timestamp": 0.17899338321607028 + }, + { + "x": 11.182766460817703, + "y": 6.531419518701983, + "heading": -0.16883330424227505, + "angularVelocity": 0.384724887467217, + "velocityX": -2.5177270572792247, + "velocityY": -0.947914739617524, + "timestamp": 0.2684900748241054 + }, + { + "x": 10.882330233029782, + "y": 6.418304523161176, + "heading": -0.12260874966451532, + "angularVelocity": 0.5164945625052538, + "velocityX": -3.3569534704515043, + "velocityY": -1.2639014234259063, + "timestamp": 0.35798676643214056 + }, + { + "x": 10.544678568903556, + "y": 6.291091383419362, + "heading": -0.12260874853394456, + "angularVelocity": 1.2632542470994776e-8, + "velocityX": -3.7727837463491594, + "velocityY": -1.4214284021947707, + "timestamp": 0.4474834580401757 + }, + { + "x": 10.20702690477794, + "y": 6.163878243477181, + "heading": -0.12260874740337606, + "angularVelocity": 1.2632517262639448e-8, + "velocityX": -3.772783744689189, + "velocityY": -1.4214284066008342, + "timestamp": 0.5369801496482108 + }, + { + "x": 9.869375240962672, + "y": 6.036665104106448, + "heading": -0.12260874627280524, + "angularVelocity": 1.263254313511497e-8, + "velocityX": -3.7727837462233933, + "velocityY": -1.421428402528582, + "timestamp": 0.626476841256246 + }, + { + "x": 9.568952859507139, + "y": 5.923536823964721, + "heading": -0.07364693995564293, + "angularVelocity": 0.5470795114035975, + "velocityX": -3.3567987476160837, + "velocityY": -1.2640498599150238, + "timestamp": 0.7159735328642811 + }, + { + "x": 9.34363659158264, + "y": 5.838690025801379, + "heading": -0.0368350275632345, + "angularVelocity": 0.4113214883253116, + "velocityX": -2.5175932510012293, + "velocityY": -0.948043960921556, + "timestamp": 0.8054702244723162 + }, + { + "x": 9.193425871877203, + "y": 5.782125253556939, + "heading": -0.012272886719585112, + "angularVelocity": 0.2744474728878599, + "velocityX": -1.6783941053799585, + "velocityY": -0.632031990730871, + "timestamp": 0.8949669160803513 + }, + { + "x": 9.11832046508789, + "y": 5.753842830657959, + "heading": -3.541695678797396e-22, + "angularVelocity": 0.13713229504992377, + "velocityX": -0.839197582807272, + "velocityY": -0.31601640745180465, + "timestamp": 0.9844636076883864 + }, + { + "x": 9.11832046508789, + "y": 5.753842830657959, + "heading": -1.742218903707832e-22, + "angularVelocity": 5.002572264403276e-23, + "velocityX": 8.398171768741014e-22, + "velocityY": 7.127695018988845e-22, + "timestamp": 1.0739602992964215 + } + ], + "eventMarkers": [] +} \ No newline at end of file diff --git a/src/main/deploy/choreo/Red CWS to 5.traj b/src/main/deploy/choreo/Red CWS to 5.traj new file mode 100644 index 00000000..e5334c3c --- /dev/null +++ b/src/main/deploy/choreo/Red CWS to 5.traj @@ -0,0 +1,122 @@ +{ + "samples": [ + { + "x": 11.633423805236816, + "y": 6.701088905334473, + "heading": -0.23748596442563125, + "angularVelocity": 4.0633007276282394e-23, + "velocityX": 6.7184741034051145e-22, + "velocityY": 5.702159340164939e-22, + "timestamp": 0 + }, + { + "x": 11.558314016783294, + "y": 6.672811015849246, + "heading": -0.22610284681530854, + "angularVelocity": 0.1271903732506324, + "velocityX": -0.8392465364248116, + "velocityY": -0.31596575222103795, + "timestamp": 0.08949669160803514 + }, + { + "x": 11.40809470327327, + "y": 6.616254752098494, + "heading": -0.2032649088498646, + "angularVelocity": 0.25518192410358925, + "velocityX": -1.678490130479727, + "velocityY": -0.6319369234749451, + "timestamp": 0.17899338321607028 + }, + { + "x": 11.182766460817703, + "y": 6.531419518701983, + "heading": -0.16883330424227505, + "angularVelocity": 0.384724887467217, + "velocityX": -2.5177270572792247, + "velocityY": -0.947914739617524, + "timestamp": 0.2684900748241054 + }, + { + "x": 10.882330233029782, + "y": 6.418304523161176, + "heading": -0.12260874966451532, + "angularVelocity": 0.5164945625052538, + "velocityX": -3.3569534704515043, + "velocityY": -1.2639014234259063, + "timestamp": 0.35798676643214056 + }, + { + "x": 10.544678568903556, + "y": 6.291091383419362, + "heading": -0.12260874853394456, + "angularVelocity": 1.2632542470994776e-8, + "velocityX": -3.7727837463491594, + "velocityY": -1.4214284021947707, + "timestamp": 0.4474834580401757 + }, + { + "x": 10.20702690477794, + "y": 6.163878243477181, + "heading": -0.12260874740337606, + "angularVelocity": 1.2632517262639448e-8, + "velocityX": -3.772783744689189, + "velocityY": -1.4214284066008342, + "timestamp": 0.5369801496482108 + }, + { + "x": 9.869375240962672, + "y": 6.036665104106448, + "heading": -0.12260874627280524, + "angularVelocity": 1.263254313511497e-8, + "velocityX": -3.7727837462233933, + "velocityY": -1.421428402528582, + "timestamp": 0.626476841256246 + }, + { + "x": 9.568952859507139, + "y": 5.923536823964721, + "heading": -0.07364693995564293, + "angularVelocity": 0.5470795114035975, + "velocityX": -3.3567987476160837, + "velocityY": -1.2640498599150238, + "timestamp": 0.7159735328642811 + }, + { + "x": 9.34363659158264, + "y": 5.838690025801379, + "heading": -0.0368350275632345, + "angularVelocity": 0.4113214883253116, + "velocityX": -2.5175932510012293, + "velocityY": -0.948043960921556, + "timestamp": 0.8054702244723162 + }, + { + "x": 9.193425871877203, + "y": 5.782125253556939, + "heading": -0.012272886719585112, + "angularVelocity": 0.2744474728878599, + "velocityX": -1.6783941053799585, + "velocityY": -0.632031990730871, + "timestamp": 0.8949669160803513 + }, + { + "x": 9.11832046508789, + "y": 5.753842830657959, + "heading": -3.541695678797396e-22, + "angularVelocity": 0.13713229504992377, + "velocityX": -0.839197582807272, + "velocityY": -0.31601640745180465, + "timestamp": 0.9844636076883864 + }, + { + "x": 9.11832046508789, + "y": 5.753842830657959, + "heading": -1.742218903707832e-22, + "angularVelocity": 5.002572264403276e-23, + "velocityX": 8.398171768741014e-22, + "velocityY": 7.127695018988845e-22, + "timestamp": 1.0739602992964215 + } + ], + "eventMarkers": [] +} \ No newline at end of file