File tree Expand file tree Collapse file tree 2 files changed +2
-24
lines changed
src/main/java/frc/team2767/deepspace Expand file tree Collapse file tree 2 files changed +2
-24
lines changed Original file line number Diff line number Diff line change @@ -41,30 +41,8 @@ protected void initialize() {
4141
4242 @ Override
4343 protected void execute () {
44- /*VISION.queryPyeye(); // gets corrected heading and range from NT
45-
46- double maxYawVelocity = 0.3; // max yaw input
47-
48- double error = VISION.getCorrectedHeading();
49- boolean isGood =
50- VISION.getCorrectedRange() >= 0; // check if range is good (we have a target), not -1*/
5144 double yaw ;
52-
53- /*if (isGood) {
54-
55- yaw = error * kP; // corrected heading is error from camera center
56-
57- // normalize yaw
58- if (yaw > maxYawVelocity) {
59- yaw = maxYawVelocity;
60- } else if (yaw < -maxYawVelocity) {
61- yaw = -maxYawVelocity;
62- }
63- } else {*/
6445 yaw = yawExpo .apply (controls .getYaw ());
65- // }
66-
67- // forward and strafe are still normal
6846 double forward = driveExpo .apply (controls .getForward ());
6947 double strafe = driveExpo .apply (controls .getStrafe ());
7048
Original file line number Diff line number Diff line change 55import edu .wpi .first .wpilibj .command .Command ;
66import frc .team2767 .deepspace .command .ZeroGyroCommand ;
77import frc .team2767 .deepspace .command .approach .sequences .AutoHatchPickupCommandGroup ;
8- import frc .team2767 .deepspace .command .approach .sequences .AutoHatchPlaceCommandGroup ;
98import frc .team2767 .deepspace .command .biscuit .BiscuitNegativeCommand ;
109import frc .team2767 .deepspace .command .biscuit .BiscuitPositiveCommand ;
1110import frc .team2767 .deepspace .command .biscuit .BiscuitStopCommand ;
@@ -88,7 +87,8 @@ public class DriverControls {
8887
8988 // gamepiece place
9089 new JoystickButton (joystick , Shoulder .LEFT_DOWN .id ).whenPressed (new ReleaseGamepieceCommand ());
91- new JoystickButton (joystick , Shoulder .LEFT_UP .id ).whenPressed (new AutoHatchPlaceCommandGroup ());
90+ // new JoystickButton(joystick, Shoulder.LEFT_UP.id).whenPressed(new
91+ // AutoHatchPlaceCommandGroup());
9292 // new JoystickButton(joystick, Shoulder.LEFT_UP.id).whenReleased(new InterruptCommand());
9393 }
9494
You can’t perform that action at this time.
0 commit comments