Autos work

This commit is contained in:
Michael Mikovsky
2026-01-20 19:23:14 -07:00
parent eb0d9de8d8
commit ba16f53d6d
6 changed files with 96 additions and 14 deletions
@@ -7,12 +7,12 @@ public final class BuildConstants {
public static final String MAVEN_GROUP = "";
public static final String MAVEN_NAME = "2026KPopRobotHunters";
public static final String VERSION = "unspecified";
public static final int GIT_REVISION = 13;
public static final String GIT_SHA = "11fa322f5922f7d432c0db927c77ec061c44eb81";
public static final String GIT_DATE = "2026-01-19 18:34:14 MST";
public static final int GIT_REVISION = 14;
public static final String GIT_SHA = "eb0d9de8d8342dc2b039ff2c80c2750776fa088f";
public static final String GIT_DATE = "2026-01-19 19:42:29 MST";
public static final String GIT_BRANCH = "Autorotate";
public static final String BUILD_DATE = "2026-01-19 19:39:28 MST";
public static final long BUILD_UNIX_TIME = 1768876768990L;
public static final String BUILD_DATE = "2026-01-20 19:19:56 MST";
public static final long BUILD_UNIX_TIME = 1768961996020L;
public static final int DIRTY = 1;
private BuildConstants(){}
@@ -10,6 +10,12 @@ import org.littletonrobotics.junction.AutoLogOutput;
import org.littletonrobotics.junction.Logger;
import com.ctre.phoenix6.swerve.SwerveRequest;
import com.pathplanner.lib.auto.AutoBuilder;
import com.pathplanner.lib.config.PIDConstants;
import com.pathplanner.lib.config.RobotConfig;
import com.pathplanner.lib.controllers.PPHolonomicDriveController;
import com.pathplanner.lib.util.PathPlannerLogging;
import edu.wpi.first.math.geometry.Pose2d;
import edu.wpi.first.math.geometry.Rotation2d;
import edu.wpi.first.math.geometry.Translation2d;
@@ -19,15 +25,9 @@ import edu.wpi.first.wpilibj2.command.SubsystemBase;
import frc4388.robot.constants.Constants.AutoConstants;
import frc4388.robot.subsystems.vision.Vision;
import frc4388.utility.compute.TimesNegativeOne;
import frc4388.utility.status.Status;
import frc4388.utility.status.FaultReporter;
import frc4388.utility.status.Queryable;
import com.pathplanner.lib.controllers.PPHolonomicDriveController;
import com.pathplanner.lib.util.PathPlannerLogging;
import com.pathplanner.lib.config.PIDConstants;
import com.pathplanner.lib.auto.AutoBuilder;
import com.pathplanner.lib.config.RobotConfig;
import frc4388.utility.status.Status;
public class SwerveDrive extends SubsystemBase implements Queryable {
// private SwerveDrivetrain<TalonFX, TalonFX, CANcoder> swerveDriveTrain;
@@ -138,6 +138,15 @@ public class SwerveDrive extends SubsystemBase implements Queryable {
initalPose2d = pose;
io.resetPose(pose);
}
// MIRA public void setOdoPose(Pose2d pose) {
// if (pose == null) return;
// io.tareEverything();
// initalPose2d = pose;
// io.resetPose(pose);
// robotKnowsWhereItIs = true;
// rotTarget = pose.getRotation().getDegrees();
// }
// public void oneModuleTest(SwerveModule module, Translation2d leftStick,
// Translation2d rightStick){