This commit is contained in:
samuel desharnais
2023-03-08 19:42:53 -05:00
16 changed files with 146 additions and 69 deletions

View File

@ -7,8 +7,8 @@ package frc.robot.subsystems;
import com.kauailabs.navx.frc.AHRS;
import com.revrobotics.CANSparkMax;
import com.revrobotics.CANSparkMaxLowLevel.MotorType;
import edu.wpi.first.wpilibj.DoubleSolenoid;
import edu.wpi.first.wpilibj.DriverStation;
import edu.wpi.first.wpilibj.PneumaticsModuleType;
import edu.wpi.first.wpilibj.DoubleSolenoid.Value;
import edu.wpi.first.wpilibj.drive.DifferentialDrive;
@ -21,11 +21,11 @@ import edu.wpi.first.wpilibj2.command.SubsystemBase;
import frc.robot.Constants;
public class BasePilotable extends SubsystemBase {
final CANSparkMax avantd = new CANSparkMax(Constants.avantdroit, MotorType.kBrushless);
final CANSparkMax avantdroit = new CANSparkMax(Constants.avantdroit, MotorType.kBrushless);
final CANSparkMax avantgauche = new CANSparkMax(Constants.avantgauche, MotorType.kBrushless);
final CANSparkMax arrieredroit = new CANSparkMax(Constants.arrieredroit, MotorType.kBrushless);
final CANSparkMax arrieregauche = new CANSparkMax(Constants.arrieregauche, MotorType.kBrushless);
final MotorControllerGroup droit = new MotorControllerGroup(avantd, arrieredroit);
final MotorControllerGroup droit = new MotorControllerGroup(avantdroit, arrieredroit);
final MotorControllerGroup gauche = new MotorControllerGroup(avantgauche, arrieregauche);
final DifferentialDrive drive = new DifferentialDrive(gauche, droit);
@ -35,28 +35,34 @@ public class BasePilotable extends SubsystemBase {
//gyro
ShuffleboardTab teb = Shuffleboard.getTab("teb");
ShuffleboardLayout layout = Shuffleboard.getTab("teb")
.getLayout ("distance", BuiltInLayouts.kList)
.getLayout ("encodeurs base pilotable", BuiltInLayouts.kList)
.withSize(2, 2);
private AHRS gyroscope = new AHRS();public double getangle() {return gyroscope.getAngle();}
public double getpitch() {
return gyroscope.getPitch();
}
public void drive(double xSpeed, double zRotation){
public void drive(double xSpeed, double zRotation, int i){
drive.arcadeDrive(xSpeed, zRotation);
}
public double distance(){
return (-avantd.getEncoder().getPosition()
teb .add ("distance",0.1);
return (-avantdroit.getEncoder().getPosition()
+avantgauche.getEncoder().getPosition()
-arrieredroit.getEncoder().getPosition()
+arrieregauche.getEncoder().getPosition()) / 4;
}
public void Reset() {
avantd.getEncoder().setPosition(0);
avantdroit.getEncoder().setPosition(0);
avantgauche.getEncoder().setPosition(0);
arrieredroit.getEncoder().setPosition(0);
arrieregauche.getEncoder().setPosition(0);
}
public void resetGyro(){
{gyroscope.reset();
}
}
public void BrakeOuvre(){
brakedroit.set(Value.kForward);
brakegauche.set(Value.kForward);
@ -65,17 +71,13 @@ public void BrakeFerme(){
brakedroit.set(Value.kReverse);
brakegauche.set(Value.kReverse);
}
public void resetGyro(){
{gyroscope.reset();}
}
/** Creates a new BasePilotable. */
public BasePilotable() {
droit.setInverted(true);
layout .addDouble("distance", this::distance);
}
@Override
public void periodic() {
}
}
}

View File

@ -3,7 +3,6 @@
// the WPILib BSD license file in the root directory of this project.
package frc.robot.subsystems;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
import com.ctre.phoenix.motorcontrol.can.WPI_TalonSRX;
import edu.wpi.first.wpilibj.DigitalInput;
@ -14,7 +13,11 @@ import edu.wpi.first.wpilibj.shuffleboard.ShuffleboardTab;
import frc.robot.Constants;
public class Gratte extends SubsystemBase {
<<<<<<< HEAD
ShuffleboardTab teb = Shuffleboard.getTab("teb");
=======
ShuffleboardTab teb = Shuffleboard.getTab("teb");
>>>>>>> fc4607f3c6d7203a155182eded4626d37f75de5e
ShuffleboardLayout limitswitchgratte = Shuffleboard.getTab("teb")
.getLayout("limitswitchsgratte", BuiltInLayouts.kList)
.withSize(2, 2);
@ -24,8 +27,16 @@ ShuffleboardLayout limitswitchgratte = Shuffleboard.getTab("teb")
private DigitalInput limithg = new DigitalInput(Constants.limithg);
private DigitalInput limitbd = new DigitalInput(Constants.limitbd);
private DigitalInput limitbg = new DigitalInput(Constants.limitbg);
public boolean baiser;
public boolean baiser;
boolean enHaut = true;
public void setenHaut(boolean enHaut){
this.enHaut = enHaut;
}
public boolean getenHaut(){
return enHaut;
}
public boolean hautd(){
return limithd.get();
}
@ -34,14 +45,19 @@ public boolean baiser;
return limithg.get();
}
public boolean basd(int i, String string){
public boolean basd(){
return limitbd.get();
}
public boolean basg(){
return limitbg.get();
}
/** Creates a new Gratte. */
public Gratte() {}
public Gratte() {
limitswitchgratte.add ("limitbd", 0.1);
limitswitchgratte.add ("limithg", 0.1);
limitswitchgratte.add ("limithd", 0.1);
limitswitchgratte.add ("limitbg", 0.1);
}
public void Lever(double vitesse){
Gratted.set(vitesse);
Gratteg.set(vitesse);
@ -51,18 +67,6 @@ public boolean baiser;
Gratteg.set(-vitesse);
}
@Override
public void periodic() {
teb .add("limithd", 0.1);
teb .add("limithg", 0.1);
teb .add("limitbd", 0.1);
teb .add("limitbg", 0.1);
limitswitchgratte.add ("limitbd", 0.1);
limitswitchgratte.add ("limithg", 0.1);
limitswitchgratte.add ("limithd", 0.1);
limitswitchgratte.add ("limitbg", 0.1);
}
public boolean basd() {
return false;
}
}
public void periodic(){
}
}

View File

@ -21,6 +21,8 @@ public class Limelight extends SubsystemBase {
PhotonCamera limelight = new PhotonCamera("limelight");
/** Creates a new Limelight. */
public Limelight() {
CameraServer.startAutomaticCapture();
teb .add("limelight", 0.1);
PortForwarder.add(5800, "photonvision.local", 5800);
}
@ -58,7 +60,5 @@ public class Limelight extends SubsystemBase {
}
@Override
public void periodic() {
CameraServer.startAutomaticCapture();
teb .add("limelight", 0.1);
}
}

View File

@ -12,14 +12,13 @@ import edu.wpi.first.wpilibj.DigitalInput;
import edu.wpi.first.wpilibj.DoubleSolenoid;
import edu.wpi.first.wpilibj.PneumaticsModuleType;
import edu.wpi.first.wpilibj.DoubleSolenoid.Value;
import edu.wpi.first.wpilibj.shuffleboard.BuiltInLayouts;
import edu.wpi.first.wpilibj.shuffleboard.Shuffleboard;
import edu.wpi.first.wpilibj.shuffleboard.ShuffleboardLayout;
import edu.wpi.first.wpilibj.shuffleboard.ShuffleboardTab;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
import frc.robot.Constants;
public class BrasTelescopique extends SubsystemBase {
<<<<<<< HEAD
ShuffleboardTab teb = Shuffleboard.getTab("teb");
ShuffleboardLayout layout = Shuffleboard.getTab("teb")
.getLayout("layout", BuiltInLayouts.kList)
@ -28,8 +27,14 @@ public class BrasTelescopique extends SubsystemBase {
ShuffleboardLayout bras = Shuffleboard.getTab("teb")
.getLayout("bras", BuiltInLayouts.kList)
.withSize(2, 2);
=======
ShuffleboardTab teb = Shuffleboard.getTab("teb");
>>>>>>> fc4607f3c6d7203a155182eded4626d37f75de5e
/** Creates a new BrasTelescopique. */
public BrasTelescopique() {}
public BrasTelescopique() {
teb .add("photocell",0.1);
teb .add("winch",0.1);
teb .add("encodeur",0.1);}
final CANSparkMax Winch = new CANSparkMax(Constants.BrasTelescopique,MotorType.kBrushless);
private DigitalInput photocell = new DigitalInput(Constants.photocell);
private DoubleSolenoid brakewinch = new DoubleSolenoid(PneumaticsModuleType.CTREPCM,Constants.brakewinchf, Constants.brakewinchb);
@ -53,8 +58,6 @@ ShuffleboardLayout bras = Shuffleboard.getTab("teb")
}
@Override
public void periodic() {
teb .add("photocell",0.1);
teb .add("winch",0.1);
bras.add ("encodeur",0.1);
}
}

View File

@ -8,7 +8,6 @@ import edu.wpi.first.wpilibj.DoubleSolenoid;
import edu.wpi.first.wpilibj.PneumaticsModuleType;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
import edu.wpi.first.wpilibj.DoubleSolenoid.Value;
import frc.robot.Constants;

View File

@ -14,7 +14,12 @@ import com.revrobotics.CANSparkMax;
import com.revrobotics.CANSparkMaxLowLevel.MotorType;
public class Pivot extends SubsystemBase {
<<<<<<< HEAD
ShuffleboardTab teb = Shuffleboard.getTab("teb");
=======
ShuffleboardTab teb = Shuffleboard.getTab("teb");
>>>>>>> fc4607f3c6d7203a155182eded4626d37f75de5e
// moteur
private CANSparkMax pivot = new CANSparkMax(Constants.pivot,MotorType.kBrushless);
private DigitalInput limitpivot = new DigitalInput(Constants.limitpivot);
@ -23,6 +28,10 @@ public class Pivot extends SubsystemBase {
public void monteDescendre(double vitesse) {
pivot.set (vitesse);
}
public Pivot(){
teb .add ("encodeurpivot",0.1);
teb .add ("limitpivot",0.1);
}
// encodeur
public double distance(){
return (pivot.getEncoder().getPosition());
@ -36,9 +45,8 @@ public class Pivot extends SubsystemBase {
}
@Override
public void periodic() {
teb .add("encodeur", 0.1);
teb .add ("encodeur pivot",0.1);
}
<<<<<<< HEAD
@ -47,3 +55,7 @@ public class Pivot extends SubsystemBase {
teb.add ("encodeur pivot",0.1);
}
}
=======
}
>>>>>>> fc4607f3c6d7203a155182eded4626d37f75de5e