Team4388/2023WayOfTheRobot
1
0
Fork 0
mirror of https://github.com/Team4388/2023WayOfTheRobot.git synced 2026-06-09 08:38:02 -06:00
Code Issues Packages Projects Releases Wiki Activity

sum changes

Browse Source
This commit is contained in:
aarav18
2023-03-24 08:03:37 -06:00
parent ff03d46a47
commit d373f25d94
3 changed files with 21 additions and 21 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/main/java/frc4388/robot/RobotContainer.java
+17 -17
View File
@@ -135,34 +135,34 @@ public class RobotContainer {
private SequentialCommandGroup placeCubeHigh =
new SequentialCommandGroup(
new PivotCommand(m_robotArm, 60 + 135),
new InstantCommand(() -> m_robotArm.setRotVel(0)),
new TeleCommand(m_robotArm, 90000),
toggleClaw.asProxy(),
armToHome.asProxy()
new WaitCommand(0.3),
new TeleCommand(m_robotArm, 90000)
// toggleClaw.asProxy(),
// armToHome.asProxy()
);
private SequentialCommandGroup placeCubeMid = new SequentialCommandGroup(
new PivotCommand(m_robotArm, 55 + 135),
new InstantCommand(() -> m_robotArm.setRotVel(0)),
new TeleCommand(m_robotArm, 28000),
toggleClaw.asProxy(),
armToHome.asProxy()
new WaitCommand(0.3),
new TeleCommand(m_robotArm, 28000)
// toggleClaw.asProxy(),
// armToHome.asProxy()
);
private SequentialCommandGroup placeCubeLow = new SequentialCommandGroup(
new TimedCommand(() -> new RunCommand(() -> m_robotSwerveDrive.driveWithInput(new Translation2d(0.0, -0.2), new Translation2d(0.0, 0.0), true), m_robotSwerveDrive), 0.7),
new PivotCommand(m_robotArm, 70 + 135),
new InstantCommand(() -> m_robotArm.setRotVel(0)),
new TeleCommand(m_robotArm, 28000),
toggleClaw.asProxy(),
armToHome.asProxy()
new WaitCommand(0.3),
new TeleCommand(m_robotArm, 28000)
// toggleClaw.asProxy(),
// armToHome.asProxy()
);
private SequentialCommandGroup placeConeHigh = new SequentialCommandGroup(
new PivotCommand(m_robotArm, 178),
new WaitCommand(0.3),
new TeleCommand(m_robotArm, 56000),
new ParallelRaceGroup(new InstantCommand(() -> m_robotClaw.toggle()), new RunCommand(() -> m_robotClaw.outtake()))
new TeleCommand(m_robotArm, 56000)
// new ParallelRaceGroup(new InstantCommand(() -> m_robotClaw.toggle()), new RunCommand(() -> m_robotClaw.outtake()))
// toggleClaw.asProxy(),
// armToHome.asProxy()
);
@@ -304,10 +304,10 @@ public class RobotContainer {
.onFalse(interruptCommand.asProxy());
// toggle claw
new JoystickButton(getDeadbandedOperatorController(), XboxController.X_BUTTON) // final
.onTrue(toggleClaw.asProxy());
// new JoystickButton(getDeadbandedOperatorController(), XboxController.X_BUTTON) // final
// .onTrue(new InstantCommand(() -> m_robotClaw.setAngle(45), m_robotClaw));
// .onTrue(toggleClaw.asProxy());
new JoystickButton(getDeadbandedOperatorController(), XboxController.X_BUTTON) // final
.onTrue(new InstantCommand(() -> m_robotClaw.setAngle(45), m_robotClaw));
// kill soft limits
new JoystickButton(getDeadbandedOperatorController(), XboxController.Y_BUTTON) // final
src/main/java/frc4388/robot/commands/Placement/AprilRotAlign.java
+2 -2
View File
@@ -26,13 +26,13 @@ public class AprilRotAlign extends PelvicInflammatoryDisease {
@Override
public double getError() {
System.out.println("Pipeline: " + lime.getCamera().getPipelineIndex());
// System.out.println("Pipeline: " + lime.getCamera().getPipelineIndex());
double err = 0.0;
try {
err = lime.getAprilSkew();
} catch (NullPointerException ex) {
System.out.println("CANT SEE APRIL POINT");
// System.out.println("CANT SEE APRIL POINT");
}
return err;
src/main/java/frc4388/robot/subsystems/Arm.java
+2 -2
View File
@@ -147,8 +147,8 @@ public class Arm extends SubsystemBase {
tele_reset = true;
}
SmartDashboard.putNumber("Pivot CANCoder", getArmRotation());
SmartDashboard.putNumber("Tele Encoder", getArmLength());
// SmartDashboard.putNumber("Pivot CANCoder", getArmRotation());
// SmartDashboard.putNumber("Tele Encoder", getArmLength());
// double x = Math.cos(Math.toRadians(degrees));
}