cone high done kinda

This commit is contained in:
aarav18
2023-03-23 18:48:57 -06:00
parent 087b04b3f7
commit 58a4c9a594
3 changed files with 20 additions and 9 deletions
@@ -158,16 +158,17 @@ public class RobotContainer {
);
private SequentialCommandGroup placeConeHigh = new SequentialCommandGroup(
new PivotCommand(m_robotArm, 0),
new TeleCommand(m_robotArm, 0),
toggleClaw.asProxy(),
armToHome.asProxy()
new PivotCommand(m_robotArm, 178),
new WaitCommand(0.3),
new TeleCommand(m_robotArm, 56000)
// toggleClaw.asProxy(),
// armToHome.asProxy()
);
private SequentialCommandGroup placeConeMid = new SequentialCommandGroup(
new PivotCommand(m_robotArm, 189),
new PivotCommand(m_robotArm, 188),
new WaitCommand(0.3),
new TeleCommand(m_robotArm, 34000)
new TeleCommand(m_robotArm, 29500)
// toggleClaw.asProxy(),
// armToHome.asProxy()
);
@@ -179,7 +180,6 @@ public class RobotContainer {
armToHome.asProxy()
);
/**
* The container for the robot. Contains subsystems, OI devices, and commands.
*/
@@ -304,6 +304,8 @@ public class RobotContainer {
// 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));
// kill soft limits
new JoystickButton(getDeadbandedOperatorController(), XboxController.Y_BUTTON) // final