mirror of
https://github.com/PhotonVision/photonvision
synced 2026-06-19 00:41:41 +00:00
Upgrade Gradle, fix build, and format
This commit is contained in:
@@ -122,8 +122,7 @@ public class SwerveDrive {
|
||||
* @param omega Angular velocity (rotation CCW+)
|
||||
*/
|
||||
public void drive(double vx, double vy, double omega) {
|
||||
var targetChassisSpeeds =
|
||||
new ChassisSpeeds(vx, vy, omega).toRobotRelative(getHeading());
|
||||
var targetChassisSpeeds = new ChassisSpeeds(vx, vy, omega).toRobotRelative(getHeading());
|
||||
setChassisSpeeds(targetChassisSpeeds, true, false);
|
||||
}
|
||||
|
||||
@@ -269,8 +268,7 @@ public class SwerveDrive {
|
||||
ChassisSpeeds chassisSpeeds = getChassisSpeeds();
|
||||
SmartDashboard.putNumber(table + "VX", chassisSpeeds.vx);
|
||||
SmartDashboard.putNumber(table + "VY", chassisSpeeds.vy);
|
||||
SmartDashboard.putNumber(
|
||||
table + "Omega Degrees", Math.toDegrees(chassisSpeeds.omega));
|
||||
SmartDashboard.putNumber(table + "Omega Degrees", Math.toDegrees(chassisSpeeds.omega));
|
||||
SmartDashboard.putNumber(table + "Target VX", targetChassisSpeeds.vx);
|
||||
SmartDashboard.putNumber(table + "Target VY", targetChassisSpeeds.vy);
|
||||
SmartDashboard.putNumber(
|
||||
|
||||
@@ -92,8 +92,7 @@ public class SwerveModule {
|
||||
double drivePid = 0;
|
||||
if (!openLoop) {
|
||||
// Perform PID feedback control to compensate for disturbances
|
||||
drivePid =
|
||||
drivePidController.calculate(driveEncoder.getRate(), desiredState.speed);
|
||||
drivePid = drivePidController.calculate(driveEncoder.getRate(), desiredState.speed);
|
||||
}
|
||||
|
||||
driveMotor.setVoltage(driveFF + drivePid);
|
||||
@@ -156,11 +155,9 @@ public class SwerveModule {
|
||||
table + "Steer Degrees", Math.toDegrees(MathUtil.angleModulus(state.angle.getRadians())));
|
||||
SmartDashboard.putNumber(
|
||||
table + "Steer Target Degrees", Math.toDegrees(steerPidController.getSetpoint()));
|
||||
SmartDashboard.putNumber(table + "Drive Velocity Feet", Units.metersToFeet(state.speed));
|
||||
SmartDashboard.putNumber(
|
||||
table + "Drive Velocity Feet", Units.metersToFeet(state.speed));
|
||||
SmartDashboard.putNumber(
|
||||
table + "Drive Velocity Target Feet",
|
||||
Units.metersToFeet(desiredState.speed));
|
||||
table + "Drive Velocity Target Feet", Units.metersToFeet(desiredState.speed));
|
||||
SmartDashboard.putNumber(table + "Drive Current", driveCurrentSim);
|
||||
SmartDashboard.putNumber(table + "Steer Current", steerCurrentSim);
|
||||
}
|
||||
|
||||
@@ -122,8 +122,7 @@ public class SwerveDrive {
|
||||
* @param omega Angular velocity (rotation CCW+)
|
||||
*/
|
||||
public void drive(double vx, double vy, double omega) {
|
||||
var targetChassisSpeeds =
|
||||
new ChassisSpeeds(vx, vy, omega).toRobotRelative(getHeading());
|
||||
var targetChassisSpeeds = new ChassisSpeeds(vx, vy, omega).toRobotRelative(getHeading());
|
||||
setChassisSpeeds(targetChassisSpeeds, true, false);
|
||||
}
|
||||
|
||||
@@ -269,8 +268,7 @@ public class SwerveDrive {
|
||||
ChassisSpeeds chassisSpeeds = getChassisSpeeds();
|
||||
SmartDashboard.putNumber(table + "VX", chassisSpeeds.vx);
|
||||
SmartDashboard.putNumber(table + "VY", chassisSpeeds.vy);
|
||||
SmartDashboard.putNumber(
|
||||
table + "Omega Degrees", Math.toDegrees(chassisSpeeds.omega));
|
||||
SmartDashboard.putNumber(table + "Omega Degrees", Math.toDegrees(chassisSpeeds.omega));
|
||||
SmartDashboard.putNumber(table + "Target VX", targetChassisSpeeds.vx);
|
||||
SmartDashboard.putNumber(table + "Target VY", targetChassisSpeeds.vy);
|
||||
SmartDashboard.putNumber(
|
||||
|
||||
@@ -92,8 +92,7 @@ public class SwerveModule {
|
||||
double drivePid = 0;
|
||||
if (!openLoop) {
|
||||
// Perform PID feedback control to compensate for disturbances
|
||||
drivePid =
|
||||
drivePidController.calculate(driveEncoder.getRate(), desiredState.speed);
|
||||
drivePid = drivePidController.calculate(driveEncoder.getRate(), desiredState.speed);
|
||||
}
|
||||
|
||||
driveMotor.setVoltage(driveFF + drivePid);
|
||||
@@ -156,11 +155,9 @@ public class SwerveModule {
|
||||
table + "Steer Degrees", Math.toDegrees(MathUtil.angleModulus(state.angle.getRadians())));
|
||||
SmartDashboard.putNumber(
|
||||
table + "Steer Target Degrees", Math.toDegrees(steerPidController.getSetpoint()));
|
||||
SmartDashboard.putNumber(table + "Drive Velocity Feet", Units.metersToFeet(state.speed));
|
||||
SmartDashboard.putNumber(
|
||||
table + "Drive Velocity Feet", Units.metersToFeet(state.speed));
|
||||
SmartDashboard.putNumber(
|
||||
table + "Drive Velocity Target Feet",
|
||||
Units.metersToFeet(desiredState.speed));
|
||||
table + "Drive Velocity Target Feet", Units.metersToFeet(desiredState.speed));
|
||||
SmartDashboard.putNumber(table + "Drive Current", driveCurrentSim);
|
||||
SmartDashboard.putNumber(table + "Steer Current", steerCurrentSim);
|
||||
}
|
||||
|
||||
@@ -50,8 +50,7 @@ public class GamepieceLauncher {
|
||||
}
|
||||
|
||||
public void periodic() {
|
||||
double maxRPM =
|
||||
Units.radiansPerSecondToRotationsPerMinute(DCMotor.getFalcon500(1).freeSpeed);
|
||||
double maxRPM = Units.radiansPerSecondToRotationsPerMinute(DCMotor.getFalcon500(1).freeSpeed);
|
||||
curMotorCmd = curDesSpd / maxRPM;
|
||||
curMotorCmd = MathUtil.clamp(curMotorCmd, 0.0, 1.0);
|
||||
motor.set(curMotorCmd);
|
||||
|
||||
@@ -122,8 +122,7 @@ public class SwerveDrive {
|
||||
* @param omega Angular velocity (rotation CCW+)
|
||||
*/
|
||||
public void drive(double vx, double vy, double omega) {
|
||||
var targetChassisSpeeds =
|
||||
new ChassisSpeeds(vx, vy, omega).toRobotRelative(getHeading());
|
||||
var targetChassisSpeeds = new ChassisSpeeds(vx, vy, omega).toRobotRelative(getHeading());
|
||||
setChassisSpeeds(targetChassisSpeeds, true, false);
|
||||
}
|
||||
|
||||
@@ -269,8 +268,7 @@ public class SwerveDrive {
|
||||
ChassisSpeeds chassisSpeeds = getChassisSpeeds();
|
||||
SmartDashboard.putNumber(table + "VX", chassisSpeeds.vx);
|
||||
SmartDashboard.putNumber(table + "VY", chassisSpeeds.vy);
|
||||
SmartDashboard.putNumber(
|
||||
table + "Omega Degrees", Math.toDegrees(chassisSpeeds.omega));
|
||||
SmartDashboard.putNumber(table + "Omega Degrees", Math.toDegrees(chassisSpeeds.omega));
|
||||
SmartDashboard.putNumber(table + "Target VX", targetChassisSpeeds.vx);
|
||||
SmartDashboard.putNumber(table + "Target VY", targetChassisSpeeds.vy);
|
||||
SmartDashboard.putNumber(
|
||||
|
||||
@@ -92,8 +92,7 @@ public class SwerveModule {
|
||||
double drivePid = 0;
|
||||
if (!openLoop) {
|
||||
// Perform PID feedback control to compensate for disturbances
|
||||
drivePid =
|
||||
drivePidController.calculate(driveEncoder.getRate(), desiredState.speed);
|
||||
drivePid = drivePidController.calculate(driveEncoder.getRate(), desiredState.speed);
|
||||
}
|
||||
|
||||
driveMotor.setVoltage(driveFF + drivePid);
|
||||
@@ -156,11 +155,9 @@ public class SwerveModule {
|
||||
table + "Steer Degrees", Math.toDegrees(MathUtil.angleModulus(state.angle.getRadians())));
|
||||
SmartDashboard.putNumber(
|
||||
table + "Steer Target Degrees", Math.toDegrees(steerPidController.getSetpoint()));
|
||||
SmartDashboard.putNumber(table + "Drive Velocity Feet", Units.metersToFeet(state.speed));
|
||||
SmartDashboard.putNumber(
|
||||
table + "Drive Velocity Feet", Units.metersToFeet(state.speed));
|
||||
SmartDashboard.putNumber(
|
||||
table + "Drive Velocity Target Feet",
|
||||
Units.metersToFeet(desiredState.speed));
|
||||
table + "Drive Velocity Target Feet", Units.metersToFeet(desiredState.speed));
|
||||
SmartDashboard.putNumber(table + "Drive Current", driveCurrentSim);
|
||||
SmartDashboard.putNumber(table + "Steer Current", steerCurrentSim);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user