This commit is contained in:
Olivier Dubois 2023-03-07 19:17:57 -05:00
commit fc866caea7
2 changed files with 6 additions and 5 deletions

View File

@ -3,7 +3,7 @@
// the WPILib BSD license file in the root directory of this project. // the WPILib BSD license file in the root directory of this project.
package frc.robot; package frc.robot;
import edu.wpi.first.cameraserver.CameraServer;
import edu.wpi.first.wpilibj2.command.Command; import edu.wpi.first.wpilibj2.command.Command;
import edu.wpi.first.wpilibj2.command.Commands; import edu.wpi.first.wpilibj2.command.Commands;
import edu.wpi.first.wpilibj2.command.SequentialCommandGroup; import edu.wpi.first.wpilibj2.command.SequentialCommandGroup;
@ -34,6 +34,7 @@ import frc.robot.commands.bras.PivoteBrasMilieux;
public class RobotContainer { public class RobotContainer {
CameraServer.startAutomaticCapture();
CommandXboxController manette1 = new CommandXboxController(0); CommandXboxController manette1 = new CommandXboxController(0);
CommandXboxController manette2 = new CommandXboxController(1); CommandXboxController manette2 = new CommandXboxController(1);
// subsystems // subsystems

View File

@ -28,13 +28,13 @@ public class Gyro extends CommandBase {
// Called every time the scheduler runs while the command is scheduled. // Called every time the scheduler runs while the command is scheduled.
@Override @Override
public void execute() { public void execute() {
if(basePilotable.getpitch()<10) if(basePilotable.getpitch()>4)
{ {
basePilotable.drive(0.4, 0); basePilotable.drive(0.3*basePilotable.getpitch()/15, 0);
} }
else if(basePilotable.getpitch()>-10) else if(basePilotable.getpitch()<-4)
{ {
basePilotable.drive(-0.4, 0); basePilotable.drive(0.3*basePilotable.getpitch()/15, 0);
} }
else else
{ {