mirror of
https://github.com/Team4388/2025RidgeScape.git
synced 2026-06-08 16:28:04 -06:00
add || true to swervedrive seeding logic
This commit is contained in:
@@ -341,7 +341,7 @@ public class SwerveDrive extends Subsystem {
|
|||||||
vision.setLastOdomPose(curpose);
|
vision.setLastOdomPose(curpose);
|
||||||
setLastOdomSpeed(curpose, lastPose, freq);
|
setLastOdomSpeed(curpose, lastPose, freq);
|
||||||
|
|
||||||
if (vision.isTag()) {
|
if (vision.isTag() || true) {
|
||||||
Pose2d pose = vision.getPose2d();
|
Pose2d pose = vision.getPose2d();
|
||||||
if (!robotKnowsWhereItIs) {
|
if (!robotKnowsWhereItIs) {
|
||||||
robotKnowsWhereItIs = true;
|
robotKnowsWhereItIs = true;
|
||||||
|
|||||||
@@ -191,7 +191,7 @@ public class Vision extends Subsystem {
|
|||||||
|
|
||||||
|
|
||||||
// lastVisionPose = new Pose2d(X/cams, Y/cams, Rotation2d.fromDegrees(curAngle + rotations*360));
|
// lastVisionPose = new Pose2d(X/cams, Y/cams, Rotation2d.fromDegrees(curAngle + rotations*360));
|
||||||
lastVisionPose = new Pose2d(0, 0, Rotation2d.fromDegrees(curAngle + rotations*360));
|
lastVisionPose = new Pose2d(10, 5, Rotation2d.fromDegrees(curAngle + rotations*360));
|
||||||
|
|
||||||
SmartDashboard.putNumber("curAngle", lastVisionPose.getRotation().getRadians());
|
SmartDashboard.putNumber("curAngle", lastVisionPose.getRotation().getRadians());
|
||||||
SmartDashboard.putNumber("Rotations", rotations);
|
SmartDashboard.putNumber("Rotations", rotations);
|
||||||
|
|||||||
Reference in New Issue
Block a user