This commit is contained in:
EdwardFaucher
2023-03-22 18:16:48 -04:00
parent 3b22a181cc
commit 77a03a5b34
5 changed files with 13 additions and 10 deletions

View File

@ -17,6 +17,7 @@ import edu.wpi.first.wpilibj.shuffleboard.Shuffleboard;
import edu.wpi.first.wpilibj.shuffleboard.ShuffleboardTab;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
import frc.robot.Constants;
import frc.robot.commands.bras.Bougerbras;
public class BasePilotable extends SubsystemBase {
final CANSparkMax avantdroit = new CANSparkMax(Constants.avantdroit, MotorType.kBrushless);
@ -42,6 +43,9 @@ public class BasePilotable extends SubsystemBase {
public void drive(double xSpeed, double zRotation){
drive.arcadeDrive(xSpeed, zRotation);
}
public void drive(double xSpeed, double zRotation, boolean square){
drive.arcadeDrive(xSpeed, zRotation, square);
}
public double distance(){
return (-avantdroit.getEncoder().getPosition()
+avantgauche.getEncoder().getPosition()

View File

@ -41,12 +41,13 @@ public class Limelight extends SubsystemBase {
public void tape() {
limelight.setLED(VisionLEDMode.kOn);
limelight.setPipelineIndex(1);
}
public double getYaw() {
var result = limelight.getLatestResult();
if(result.hasTargets()){
return -result.getBestTarget().getYaw()/30;
return -result.getBestTarget().getYaw()/45;
}
return 0;