10 Commits

Author SHA1 Message Date
8a7f10ec64 id 2025-02-03 18:24:08 -05:00
345eb83d39 id 2025-02-03 18:23:17 -05:00
f01f327c81 id 2025-02-03 18:22:01 -05:00
0c7cfc9d4c id 2025-02-03 18:20:20 -05:00
831b9fec75 Touche grinpeur 2025-01-29 19:51:59 -05:00
982db16833 grimpeMieux 2025-01-28 19:22:43 -05:00
12b5e6954e 2025-01-28 18:31:02 -05:00
7e40328af4 il grimpe mieux 2025-01-28 17:51:17 -05:00
9653ca7205 grimpe 2025-01-27 19:12:49 -05:00
1583a95f52 il grimpe 2025-01-27 18:40:58 -05:00
14 changed files with 74 additions and 531 deletions

View File

@ -1,12 +1,7 @@
{ {
"FMS": { "System Joysticks": {
"window": { "window": {
"visible": false "enabled": false
}
},
"Joysticks": {
"window": {
"visible": false
} }
}, },
"keyboardJoysticks": [ "keyboardJoysticks": [
@ -98,12 +93,5 @@
"buttonCount": 0, "buttonCount": 0,
"povCount": 0 "povCount": 0
} }
],
"robotJoysticks": [
{},
{
"guid": "78696e70757401000000000000000000",
"useGamepad": true
}
] ]
} }

View File

@ -4,43 +4,24 @@
package frc.robot; package frc.robot;
import edu.wpi.first.math.MathUtil;
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.RunCommand;
import edu.wpi.first.wpilibj2.command.button.CommandXboxController; import edu.wpi.first.wpilibj2.command.button.CommandXboxController;
import frc.robot.commands.BalayeuseAlgue; import frc.robot.command.GrimperHaut;
import frc.robot.commands.BalayeuseBas; import frc.robot.command.GrimpeurBas;
import frc.robot.commands.BalayeuseCoral; import frc.robot.subsystems.Grimpeur;
import frc.robot.commands.BalayeuseHaut;
import frc.robot.commands.L1Requin;
import frc.robot.commands.aspire;
import frc.robot.commands.exspire;
import frc.robot.commands.requin_manuel;
import frc.robot.subsystems.Requin;
import frc.robot.subsystems.Bougie;
import frc.robot.commands.aspire;
public class RobotContainer { public class RobotContainer {
CommandXboxController manette1 = new CommandXboxController(0); CommandXboxController manette1 = new CommandXboxController(0);
CommandXboxController manette2 = new CommandXboxController(1); CommandXboxController manette2 = new CommandXboxController(0);
Requin requin = new Requin(); Grimpeur grimpeur = new Grimpeur();
Bougie bougie = new Bougie();
aspire aspire = new aspire(requin);
requin_manuel requin_manuel = new requin_manuel(requin);
public RobotContainer() { public RobotContainer() {
configureBindings(); configureBindings();
requin.setDefaultCommand(new RunCommand(()->{
requin.rotationer(MathUtil.applyDeadband(manette2.getRightY(), 0.2));
}, requin));
} }
private void configureBindings() { private void configureBindings() {
manette2.a().whileTrue(new aspire(requin)); manette1.leftBumper().whileTrue(new GrimperHaut(grimpeur));
manette2.rightTrigger().whileTrue(new exspire(requin)); manette1.rightBumper().whileTrue(new GrimpeurBas(grimpeur));
manette2.b().whileTrue(new BalayeuseAlgue(requin, bougie));
manette2.x().whileTrue(new BalayeuseCoral(requin, bougie));
manette2.y().whileTrue(new L1Requin(requin,bougie));
manette2.rightBumper().whileTrue(new BalayeuseHaut(requin));
} }
public Command getAutonomousCommand() { public Command getAutonomousCommand() {

View File

@ -2,18 +2,18 @@
// Open Source Software; you can modify and/or share it under the terms of // Open Source Software; you can modify and/or share it under the terms of
// 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.commands; package frc.robot.command;
import edu.wpi.first.wpilibj2.command.Command; import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.subsystems.Requin; import frc.robot.subsystems.Grimpeur;
/* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */ /* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */
public class BalayeuseHaut extends Command { public class GrimperHaut extends Command {
private Requin requin; private Grimpeur grimpeur;
/** Creates a new Balayeuse. */ /** Creates a new Grimper. */
public BalayeuseHaut(Requin requin) { public GrimperHaut(Grimpeur grimpeur) {
this.requin = requin; this.grimpeur = new Grimpeur();
addRequirements(requin); addRequirements(grimpeur);
// Use addRequirements() here to declare subsystem dependencies. // Use addRequirements() here to declare subsystem dependencies.
} }
@ -24,24 +24,24 @@ public class BalayeuseHaut extends Command {
// 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(requin.enHaut()==true){ if(grimpeur.stop()==true){
requin.rotationer(0); grimpeur.grimpe(0);
requin.reset(); grimpeur.reset();
} }
else{ else{
requin.rotationer(-0.5); grimpeur.grimpe(0.5);
} }
} }
// Called once the command ends or is interrupted. // Called once the command ends or is interrupted.
@Override @Override
public void end(boolean interrupted) { public void end(boolean interrupted) {
requin.rotationer(0); grimpeur.grimpe(0);
} }
// Returns true when the command should end. // Returns true when the command should end.
@Override @Override
public boolean isFinished() { public boolean isFinished() {
return false; return grimpeur.stop()==true;
} }
} }

View File

@ -2,22 +2,19 @@
// Open Source Software; you can modify and/or share it under the terms of // Open Source Software; you can modify and/or share it under the terms of
// 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.commands; package frc.robot.command;
import java.util.function.DoubleSupplier;
import edu.wpi.first.wpilibj2.command.Command; import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.subsystems.Requin; import frc.robot.subsystems.Grimpeur;
/* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */ /* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */
public class requin_manuel extends Command { public class GrimpeurBas extends Command {
/** Creates a new requin_manuel. */ private Grimpeur grimpeur;
private Requin requin; /** Creates a new GrimpeurBas. */
private DoubleSupplier x; public GrimpeurBas(Grimpeur grimpeur) {
public requin_manuel(Requin requin) { this.grimpeur = grimpeur;
addRequirements(grimpeur);
// Use addRequirements() here to declare subsystem dependencies. // Use addRequirements() here to declare subsystem dependencies.
this.requin = requin;
addRequirements(requin);
} }
// Called when the command is initially scheduled. // Called when the command is initially scheduled.
@ -27,18 +24,19 @@ public class requin_manuel extends Command {
// 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(requin.enHaut()){ if(grimpeur.encodeur()>=500 && grimpeur.encodeur()<=510){
requin.rotationer(0); grimpeur.grimpe(0);
} }
else{ else if(grimpeur.encodeur()>=510){
requin.rotationer(x.getAsDouble()); grimpeur.grimpe(0.5);
} }
grimpeur.grimpe(-0.5);
} }
// Called once the command ends or is interrupted. // Called once the command ends or is interrupted.
@Override @Override
public void end(boolean interrupted) { public void end(boolean interrupted) {
requin.rotationer(0); grimpeur.grimpe(0);
} }
// Returns true when the command should end. // Returns true when the command should end.

View File

@ -1,63 +0,0 @@
// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
package frc.robot.commands;
import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.subsystems.Bougie;
import frc.robot.subsystems.Requin;
/* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */
public class BalayeuseAlgue extends Command {
private Requin requin;
private Bougie bougie;
/** Creates a new Balayeuse. */
public BalayeuseAlgue(Requin requin, Bougie bougie) {
this.requin = requin;
this.bougie =bougie;
addRequirements(requin,bougie);
// Use addRequirements() here to declare subsystem dependencies.
}
// Called when the command is initially scheduled.
@Override
public void initialize() {}
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
if(requin.encodeur()>=500 && requin.encodeur()<=510)
{
requin.rotationer(0);
if(requin.amp()> 60){
requin.balaye(0);
bougie.Vert();
}
else
{
requin.balaye(0.5);
}
}
else if(requin.encodeur()>=510){
requin.rotationer(0.5);
}
else{
requin.rotationer(-0.5);
}
}
// Called once the command ends or is interrupted.
@Override
public void end(boolean interrupted) {
requin.rotationer(0);
requin.balaye(0);
}
// Returns true when the command should end.
@Override
public boolean isFinished() {
return false;
}
}

View File

@ -1,40 +0,0 @@
// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
package frc.robot.commands;
import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.subsystems.Requin;
/* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */
public class BalayeuseBas extends Command {
private Requin requin;
/** Creates a new Balayeuse. */
public BalayeuseBas(Requin requin) {
this.requin = requin;
addRequirements(requin);
// Use addRequirements() here to declare subsystem dependencies.
}
// Called when the command is initially scheduled.
@Override
public void initialize() {}
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
requin.rotationer(-0.5);
}
// Called once the command ends or is interrupted.
@Override
public void end(boolean interrupted) {
requin.rotationer(0);
}
// Returns true when the command should end.
@Override
public boolean isFinished() {
return false;
}
}

View File

@ -1,67 +0,0 @@
// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
package frc.robot.commands;
import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.subsystems.Bougie;
import frc.robot.subsystems.Requin;
/* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */
public class BalayeuseCoral extends Command {
private Requin requin;
private Bougie bougie;
/** Creates a new Balayeuse. */
public BalayeuseCoral(Requin requin, Bougie bougie) {
this.requin = requin;
this.bougie = bougie;
addRequirements(requin,bougie);
// Use addRequirements() here to declare subsystem dependencies.
}
// Called when the command is initially scheduled.
@Override
public void initialize() {}
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
if(requin.encodeur()>=100 && requin.encodeur()<=110){
requin.rotationer(0);
if(requin.amp()>60){
requin.balaye(0);
bougie.Vert();
if(requin.enHaut()){
requin.rotationer(0);
}
else{
requin.rotationer(0.5);
}
}
else{
requin.balaye(0.5);
}
}
else if(requin.encodeur()>=110){
requin.rotationer(0.5);
}
else{
requin.rotationer(-0.5);
}
}
// Called once the command ends or is interrupted.
@Override
public void end(boolean interrupted) {
requin.rotationer(0);
requin.balaye(0);
}
// Returns true when the command should end.
@Override
public boolean isFinished() {
return false;
}
}

View File

@ -1,41 +0,0 @@
// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
package frc.robot.commands;
import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.subsystems.Requin;
/* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */
public class ExpireAlgue extends Command {
private Requin requin;
/** Creates a new ExpireAlgue. */
public ExpireAlgue(Requin requin) {
this.requin = requin;
addRequirements(requin);
// Use addRequirements() here to declare subsystem dependencies.
}
// Called when the command is initially scheduled.
@Override
public void initialize() {}
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
requin.balaye(0.5);
}
// Called once the command ends or is interrupted.
@Override
public void end(boolean interrupted) {
requin.balaye(0);
}
// Returns true when the command should end.
@Override
public boolean isFinished() {
return false;
}
}

View File

@ -1,65 +0,0 @@
// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
package frc.robot.commands;
import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.subsystems.Bougie;
import frc.robot.subsystems.Requin;
/* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */
public class L1Requin extends Command {
private Requin requin;
private Bougie bougie;
/** Creates a new Balayeuse. */
public L1Requin(Requin requin,Bougie bougie) {
this.requin = requin;
this.bougie = bougie;
addRequirements(requin,bougie);
// Use addRequirements() here to declare subsystem dependencies.
}
// Called when the command is initially scheduled.
@Override
public void initialize() {}
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
if(requin.encodeur()>=800 && requin.encodeur()<=810){
requin.rotationer(0);
if(requin.amp()>8){
requin.balaye(-0.5);
}
else{
requin.balaye(0);
bougie.Rouge();
}
}
else if(requin.encodeur()>=810){
requin.rotationer(0.5);
}
else{
requin.rotationer(-0.5);
}
}
// Called once the command ends or is interrupted.
@Override
public void end(boolean interrupted) {
requin.rotationer(0);
requin.balaye(0);
}
// Returns true when the command should end.
@Override
public boolean isFinished() {
return false;
}
}

View File

@ -1,41 +0,0 @@
// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
package frc.robot.commands;
import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.subsystems.Requin;
/* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */
public class aspire extends Command {
/** Creates a new aspire. */
private Requin requin;
public aspire(Requin requin) {
// Use addRequirements() here to declare subsystem dependencies.
this.requin = requin;
addRequirements(requin);
}
// Called when the command is initially scheduled.
@Override
public void initialize() {}
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
requin.balaye(0.3);
}
// Called once the command ends or is interrupted.
@Override
public void end(boolean interrupted) {
requin.balaye(0);
}
// Returns true when the command should end.
@Override
public boolean isFinished() {
return false;
}
}

View File

@ -1,41 +0,0 @@
// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
package frc.robot.commands;
import edu.wpi.first.wpilibj2.command.Command;
import frc.robot.subsystems.Requin;
/* You should consider using the more terse Command factories API instead https://docs.wpilib.org/en/stable/docs/software/commandbased/organizing-command-based.html#defining-commands */
public class exspire extends Command {
/** Creates a new aspire. */
private Requin requin;
public exspire(Requin requin) {
// Use addRequirements() here to declare subsystem dependencies.
this.requin = requin;
addRequirements(requin);
}
// Called when the command is initially scheduled.
@Override
public void initialize() {}
// Called every time the scheduler runs while the command is scheduled.
@Override
public void execute() {
requin.balaye(-0.3);
}
// Called once the command ends or is interrupted.
@Override
public void end(boolean interrupted) {
requin.balaye(0);
}
// Returns true when the command should end.
@Override
public boolean isFinished() {
return false;
}
}

View File

@ -1,53 +0,0 @@
// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
package frc.robot.subsystems;
import com.ctre.phoenix.led.CANdle;
import com.ctre.phoenix.led.CANdleConfiguration;
import com.ctre.phoenix.led.RainbowAnimation;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
public class Bougie extends SubsystemBase {
CANdle candle = new CANdle(23);
CANdleConfiguration config = new CANdleConfiguration();
RainbowAnimation rainbowAnim = new RainbowAnimation(1, 0.5, 64);
/** Creates a new Bougie. */
public Bougie() {
config.brightnessScalar = 0.5;
candle.configAllSettings(config);
}
public void Rouge() {
candle.setLEDs(255, 0, 0,0,8,8);
candle.setLEDs(255, 0, 0,0,24,8);
candle.setLEDs(255, 0, 0,0,40,8);
candle.setLEDs(255, 0, 0,0,56,8);
}
public void Vert() {
candle.setLEDs(0, 255, 0,0,8,8);
candle.setLEDs(0, 255, 0,0,24,8);
candle.setLEDs(0, 255, 0,0,40,8);
candle.setLEDs(0, 255, 0,0,56,8);
}
public void Bleu() {
candle.setLEDs(0, 0, 255,0,16,8);
candle.setLEDs(0, 0, 255,0,32,8);
candle.setLEDs(0, 0, 255,0,48,8);
candle.setLEDs(0, 0, 255,0,64,8);
}
public void Jaune() {
candle.setLEDs(255, 215, 0,0,16,8);
candle.setLEDs(255, 215, 0,0,32,8);
candle.setLEDs(255, 215, 0,0,48,8);
candle.setLEDs(255, 215, 0,0,64,8);
}
public void RainBow(){
candle.animate(rainbowAnim);}
public void RainBowStop(){candle.animate(null);}
@Override
public void periodic() {
// This method will be called once per scheduler run
}
}

View File

@ -0,0 +1,35 @@
// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
package frc.robot.subsystems;
import com.revrobotics.spark.SparkMax;
import com.revrobotics.spark.SparkLowLevel.MotorType;
import edu.wpi.first.wpilibj.DigitalInput;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
public class Grimpeur extends SubsystemBase {
/** Creates a new Grimpeur. */
public Grimpeur() {}
final SparkMax grimpeur = new SparkMax(10,MotorType.kBrushless);
final DigitalInput limit1 = new DigitalInput(2);
public void grimpe(double vitesse){
grimpeur.set(vitesse);
}
public boolean stop(){
return limit1.get();
}
public double encodeur(){
return grimpeur.getEncoder().getPosition();
}
public void reset(){
grimpeur.getEncoder().setPosition(0);
}
@Override
public void periodic() {
// This method will be called once per scheduler run
}
}

View File

@ -1,48 +0,0 @@
// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.
package frc.robot.subsystems;
import com.revrobotics.spark.SparkFlex;
import com.revrobotics.spark.SparkMax;
import com.revrobotics.spark.SparkLowLevel.MotorType;
import edu.wpi.first.wpilibj.DigitalInput;
import edu.wpi.first.wpilibj.shuffleboard.Shuffleboard;
import edu.wpi.first.wpilibj.shuffleboard.ShuffleboardTab;
import edu.wpi.first.wpilibj2.command.SubsystemBase;
public class Requin extends SubsystemBase {
/** Creates a new Requin. */
ShuffleboardTab teb = Shuffleboard.getTab("teb");
public Requin() {
teb.addBoolean("limit requin", this::enHaut);
}
final SparkFlex balaye = new SparkFlex(15, MotorType.kBrushless);
final SparkMax rotatione = new SparkMax(17, MotorType.kBrushless);
final DigitalInput limit3 = new DigitalInput(1);
public void balaye(double vitesse){
balaye.set(vitesse);
}
public void rotationer(double vitesse){
rotatione.set(vitesse);
}
public boolean enHaut(){
return limit3.get();
}
public double encodeur(){
return rotatione.getEncoder().getPosition();
}
public void reset(){
rotatione.getEncoder().setPosition(0);
}
public double amp(){
return balaye.getOutputCurrent();
}
@Override
public void periodic() {
// This method will be called once per scheduler run
}
}