Merge branch 'main' of https://demerso.net/pls5618/2023/robot
This commit is contained in:
@ -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() {
|
||||
|
||||
|
||||
}
|
||||
}
|
||||
}
|
||||
|
@ -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(){
|
||||
}
|
||||
}
|
@ -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);
|
||||
}
|
||||
}
|
||||
|
@ -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);
|
||||
|
||||
}
|
||||
}
|
@ -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;
|
||||
|
||||
|
||||
|
@ -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
|
||||
|
Reference in New Issue
Block a user