@@ -201,81 +201,7 @@ else if (driverController.getRightX() > 0) {
201201 return 0.0 ;
202202 });
203203
204-
205- // if (
206- // // (driverController.getTouchpad() && superSystem.getIsPassing())
207- // // ||
208- // driverController.getTriangleButton())
209- // {
210- // if (!IsRedSide()) {
211- // return 315.0;
212- // } else {
213- // return 45.0;
214- // }
215- // }
216- // if (driverController.getL2Button()) {
217- // return swerveDrive.getTurnToSpecificTagAngle(IsRedSide() ? 4 : 7); // TODO, update?
218- // // 4 if red side, 7 if blue
219- // }
220- // if (driverController.getCircleButton()) { //turn to amp
221- // if (!IsRedSide()){
222- // return 270.0;
223- // }
224- // return 90.0;
225- // }
226- // else
227- // if (driverController.getL1Button()) { //turn to speaker
228- // return 0.0;
229- // }
230- // else if (driverController.getR1Button()) {
231- // return 180.0;
232- // }
233- // if (driverController.getPSButton()) { // Turn to shuffleboard angle
234- // return SmartDashboard.getNumber("Test Desired Angle", 0);
235- // }
236-
237204 swerveDrive .setDefaultCommand (swerveJoystickCommand );
238-
239- // Point to angle
240- // swerveDrive.setDefaultCommand(
241- // new SwerveJoystickCommand(
242- // swerveDrive,
243- // () -> -commandDriverController.getLeftY(), // Horizontal translation
244- // commandDriverController::getLeftX, // Vertical Translation
245-
246- // () -> {
247- // if (driverController.getCircleButton()) {
248- // noteCamera.calculateRotationSpeed(0, 0); // Values from SwerveDrive2024/isMeToKitBot
249- // return (noteCamera.getRotationSpeed() * 180 / Math.PI) / 20; // Convert radians to degrees and divide by 20 for how often it's run
250- // }
251- // if(driverController.getR1Button() && driverController.getL2Button()){
252- // return 0.0;
253- // }
254- // if(driverController.getR1Button()){
255- // return -4.5;
256- // }
257- // if(driverController.getL2Button()){
258- // return 4.5;
259- // }
260- // return 0.0;
261- // },
262- // () -> false, // Field oriented
263- // driverController::getCrossButton, // Towing
264- // () -> driverController.getR2Button(), // Precision mode (disabled)
265- // () -> true, // Turn to angle
266- // () -> { // Turn To angle Direction
267- // double xValue = commandDriverController.getRightX();
268- // double yValue = commandDriverController.getRightY();
269- // double magnitude = (xValue*xValue) + (yValue*yValue);
270- // if (magnitude > 0.49) {
271- // double angle = (90 + NerdyMath.radiansToDegrees(Math.atan2(commandDriverController.getRightY(), commandDriverController.getRightX())));
272- // angle = (((-1 * angle) % 360) + 360) % 360;
273- // SmartDashboard.putNumber("desired angle", angle);
274- // return angle;
275- // }
276- // return 1000.0;
277- // }
278- // ));
279205 }
280206
281207 public void initDefaultCommands_test () {}
0 commit comments