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

Merge branch 'master' into autonomous

Browse Source
This commit is contained in:
Aarav Shah
2023-02-17 19:53:58 -07:00
committed by GitHub
parent 7c57dd53e8 42ee61ad2b
commit 52021a8646
8 changed files with 1165 additions and 61 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/main/java/frc4388/robot/subsystems/SwerveDrive.java
+14 -5
View File
@@ -205,6 +205,12 @@ public class SwerveDrive extends SubsystemBase {
public void resetPoseEstimator() {
setPoseEstimator(new Pose2d());
}
public void stopModules() {
for (SwerveModule module : this.modules) {
module.stop();
}
}
/**
* Resets the odometry of the SwerveDrive to 0.
@@ -221,14 +227,17 @@ public class SwerveDrive extends SubsystemBase {
@Override
public void periodic() {
// This method will be called once per scheduler run
// updateOdometry();
updatePoseEstimator();
// SmartDashboard.putNumber("Odo X", getOdometry().getX());
// SmartDashboard.putNumber("Odo Y", getOdometry().getY());
// SmartDashboard.putNumber("Odo Theta", getOdometry().getRotation().getDegrees());
// SmartDashboard.putNumber("Gyro Angle", getGyroAngle());
SmartDashboard.putNumber("Odo X (ft)", Units.metersToFeet(this.getOdometry().getX()));
SmartDashboard.putNumber("Odo Y (ft)", Units.metersToFeet(this.getOdometry().getY()));
SmartDashboard.putNumber("Odo Theta", this.getOdometry().getRotation().getDegrees());
SmartDashboard.putNumber("Gyro Angle", getGyroAngle());
SmartDashboard.putNumber("rotTarget", this.rotTarget.getDegrees());
}
/**