Team4388/2023WayOfTheRobot
1
0
Fork 0
mirror of https://github.com/Team4388/2023WayOfTheRobot.git synced 2026-06-09 08:38:02 -06:00
Code Issues Packages Projects Releases Wiki Activity

cummit

Browse Source
This commit is contained in:
aarav18
2023-03-13 16:00:09 -06:00
parent e98c3a09e1
commit e3234fb51d
2 changed files with 37 additions and 21 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/main/java/frc4388/robot/RobotContainer.java
+20 -7
View File
@@ -7,6 +7,8 @@
package frc4388.robot;
import com.ctre.phoenix.motorcontrol.TalonFXControlMode;
import edu.wpi.first.wpilibj.PWM;
import edu.wpi.first.wpilibj.Servo;
import edu.wpi.first.wpilibj.smartdashboard.SendableChooser;
@@ -136,18 +138,29 @@ public class RobotContainer {
.onFalse(new InstantCommand());
// * Operator Buttons
new JoystickButton(getDeadbandedOperatorController(), XboxController.X_BUTTON)
// .onTrue(new InstantCommand(() -> System.out.println("Claw Button")));
.onTrue(new InstantCommand(() -> m_robotClaw.toggle()));
// new JoystickButton(getDeadbandedOperatorController(), XboxController.X_BUTTON)
// // .onTrue(new InstantCommand(() -> System.out.println("Claw Button")));
// .onTrue(new InstantCommand(() -> m_robotClaw.toggle()));
new JoystickButton(getDeadbandedOperatorController(), XboxController.A_BUTTON)
.whileTrue(new RunCommand(() -> m_robotArm.m_pivot.set(TalonFXControlMode.Position, 200), m_robotArm));
new JoystickButton(getDeadbandedOperatorController(), XboxController.B_BUTTON)
.whileTrue(new RunCommand(() -> m_robotArm.m_pivot.set(TalonFXControlMode.Position, 135), m_robotArm));
new JoystickButton(getDeadbandedOperatorController(), XboxController.X_BUTTON)
.whileTrue(new RunCommand(() -> m_robotArm.m_pivot.set(TalonFXControlMode.Position, 225), m_robotArm));
new JoystickButton(getDeadbandedOperatorController(), XboxController.Y_BUTTON)
.onTrue(new InstantCommand(() -> m_robotArm.killSoftLimits()));
new JoystickButton(getDeadbandedOperatorController(), XboxController.A_BUTTON)
.onTrue(new InstantCommand(() -> m_robotArm.resetTeleSoftLimit(), m_robotArm));
// new JoystickButton(getDeadbandedOperatorController(), XboxController.A_BUTTON)
// .onTrue(new InstantCommand(() -> m_robotArm.resetTeleSoftLimit(), m_robotArm));
new JoystickButton(getDeadbandedOperatorController(), XboxController.LEFT_BUMPER_BUTTON)
.onTrue(new InstantCommand(() -> {}, m_robotArm, m_robotSwerveDrive, m_robotClaw));
// new JoystickButton(getDeadbandedOperatorController(), XboxController.LEFT_BUMPER_BUTTON)
// .onTrue(new InstantCommand(() -> {}, m_robotArm, m_robotSwerveDrive, m_robotClaw));
}
/**
src/main/java/frc4388/robot/subsystems/Arm.java
+17 -14
View File
@@ -3,6 +3,7 @@ package frc4388.robot.subsystems;
import com.ctre.phoenix.motorcontrol.ControlMode;
import com.ctre.phoenix.motorcontrol.FeedbackDevice;
import com.ctre.phoenix.motorcontrol.RemoteSensorSource;
import com.ctre.phoenix.motorcontrol.TalonFXFeedbackDevice;
import com.ctre.phoenix.motorcontrol.can.TalonFXConfiguration;
import com.ctre.phoenix.motorcontrol.can.WPI_TalonFX;
import com.ctre.phoenix.sensors.CANCoder;
@@ -16,7 +17,7 @@ import edu.wpi.first.wpilibj2.command.SubsystemBase;
public class Arm extends SubsystemBase {
private WPI_TalonFX m_tele;
private WPI_TalonFX m_pivot;
public WPI_TalonFX m_pivot;
private CANCoder m_pivotEncoder;
private boolean m_debug;
@@ -29,15 +30,16 @@ public class Arm extends SubsystemBase {
tele.configFactoryDefault();
m_pivot.configFactoryDefault();
TalonFXConfiguration pivotConfig = new TalonFXConfiguration();
pivotConfig.slot0.kP = ArmConstants.kP;
pivotConfig.slot0.kI = ArmConstants.kI;
pivotConfig.slot0.kD = ArmConstants.kD;
// TalonFXConfiguration pivotConfig = new TalonFXConfiguration();
// pivotConfig.slot0.kP = 0.5;//ArmConstants.kP;
// pivotConfig.slot0.kI = 0.0;//ArmConstants.kI;
// pivotConfig.slot0.kD = 0.0;//ArmConstants.kD;
pivotConfig.remoteFilter0.remoteSensorDeviceID = encoder.getDeviceID();
pivotConfig.remoteFilter0.remoteSensorSource = RemoteSensorSource.CANCoder;
pivotConfig.primaryPID.selectedFeedbackSensor = FeedbackDevice.RemoteSensor0;
m_pivot.configAllSettings(pivotConfig);
// pivotConfig.primaryPID.selectedFeedbackSensor = FeedbackDevice.RemoteSensor0;
// pivotConfig.remoteFilter0.remoteSensorDeviceID = encoder.getDeviceID();
// pivotConfig.remoteFilter0.remoteSensorSource = RemoteSensorSource.CANCoder;
// m_pivot.configAllSettings(pivotConfig);
resetTeleSoftLimit();
@@ -58,17 +60,18 @@ public class Arm extends SubsystemBase {
pivotConfig_.slot0.kI = SmartDashboard.getNumber("kI Pivot", 0);
pivotConfig_.slot0.kD = SmartDashboard.getNumber("kD Pivot", 0);
pivotConfig_.primaryPID.selectedFeedbackSensor = FeedbackDevice.RemoteSensor0;
pivotConfig_.remoteFilter0.remoteSensorDeviceID = encoder.getDeviceID();
pivotConfig_.remoteFilter0.remoteSensorSource = RemoteSensorSource.CANCoder;
// pivotConfig_.remoteFilter0.remoteSensorDeviceID = encoder.getDeviceID();
// pivotConfig_.remoteFilter0.remoteSensorSource = RemoteSensorSource.CANCoder;
// pivotConfig_.configSelectedFeedbackFilter();// FeedbackDevice.RemoteSensor0;
m_pivot.configAllSettings(pivotConfig_);
m_pivot.configRemoteFeedbackFilter(encoder.getDeviceID(), RemoteSensorSource.CANCoder, 0);
m_pivot.configSelectedFeedbackSensor(FeedbackDevice.RemoteSensor0);
// m_pivot.configRemoteFeedbackFilter(encoder.getDeviceID(), RemoteSensorSource.CANCoder, 0);
// m_pivot.configSelectedFeedbackSensor(FeedbackDevice.RemoteSensor0);
// m_pivot.selectProfileSlot(0, 0);
}));
SmartDashboard.putData("set pos 1", new RunCommand(() -> m_pivot.set(ControlMode.Position, 225), this));
SmartDashboard.putData("set pos 2", new RunCommand(() -> m_pivot.set(ControlMode.Position, 135), this));
SmartDashboard.putData("Kill Self", new InstantCommand(() -> {}, this));
}