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

pid done

Browse Source
This commit is contained in:
aarav18
2023-02-02 19:43:47 -07:00
parent b576678368
commit e3d591674a
4 changed files with 14 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/main/java/frc4388/robot/Robot.java
+3 -3
View File
@@ -158,9 +158,9 @@ public class Robot extends TimedRobot {
*/
@Override
public void teleopPeriodic() {
// SmartDashboard.putNumber("yaw", m_robotContainer.gyroRef.getAngle());
// SmartDashboard.putNumber("pitch", m_robotContainer.gyroRef.getPitch());
// SmartDashboard.putNumber("roll", m_robotContainer.gyroRef.getRoll());
// SmartDashboard.putNumber("yaw", m_robotContainer.m_robotMap.gyro.getAngle());
SmartDashboard.putNumber("Robot.java Pitch", m_robotContainer.m_robotMap.gyro.getPitch());
// SmartDashboard.putNumber("roll", m_robotContainer.m_robotMap.gyro.getRoll());
}
/**
src/main/java/frc4388/robot/RobotContainer.java
+4 -3
View File
@@ -36,7 +36,7 @@ import frc4388.utility.controller.XboxController;
*/
public class RobotContainer {
/* RobotMap */
private final RobotMap m_robotMap = new RobotMap();
public final RobotMap m_robotMap = new RobotMap();
/* Subsystems */
public final SwerveDrive m_robotSwerveDrive = new SwerveDrive(m_robotMap.leftFront, m_robotMap.rightFront, m_robotMap.leftBack, m_robotMap.rightBack);//, m_robotMap.gyro);
@@ -99,8 +99,9 @@ public class RobotContainer {
private void configureButtonBindings() {
/* Driver Buttons */
// new JoystickButton(getDriverJoystick(), XboxController.A_BUTTON)
// .onTrue(new InstantCommand(() -> gyroRef.reset()));
new JoystickButton(getDriverJoystick(), XboxController.A_BUTTON)
.onTrue(new InstantCommand(() -> m_robotMap.gyro.reset()));
// .onFalse()
/* Operator Buttons */
// activates "Lit Mode"
src/main/java/frc4388/robot/commands/AutoBalance.java
+6 -2
View File
@@ -19,7 +19,11 @@ public class AutoBalance extends PelvicInflammatoryDisease {
/** Creates a new AutoBalanceTF2. */
public AutoBalance(RobotGyro gyro, SwerveDrive drive) {
super(.7, .1, 15, 0);
super(1.0, 0, 0, 0);
this.gyro = gyro;
this.drive = drive;
addRequirements(drive);
}
@@ -40,7 +44,7 @@ public class AutoBalance extends PelvicInflammatoryDisease {
@Override
public void initialize() {
super.initialize();
this.gyro.reset();
// this.gyro.reset();
}
// Returns true when the command should end.
src/main/java/frc4388/robot/subsystems/SwerveModule.java
+1 -1
View File
@@ -140,7 +140,7 @@ public class SwerveModule extends SubsystemBase {
double feetPerSecond = Units.metersToFeet(state.speedMetersPerSecond);
double inchesPerSecond = Units.metersToInches(state.speedMetersPerSecond);
driveMotor.set(/*angleMotor.get() + */feetPerSecond / SwerveDriveConstants.MAX_SPEED_FEET_PER_SECOND);
driveMotor.set(-1 * angleMotor.get() + feetPerSecond / SwerveDriveConstants.MAX_SPEED_FEET_PER_SECOND);
// driveMotor.set(TalonFXControlMode.Velocity, inchesPerSecond * SwerveDriveConstants.Conversions.TICKS_PER_INCH * SwerveDriveConstants.Conversions.SECONDS_TO_TICK_TIME);
}