Skip to content

Commit 53c27d7

Browse files
use no offset and fix imports & update questnav
1 parent b7ca7f3 commit 53c27d7

4 files changed

Lines changed: 17 additions & 7 deletions

File tree

src/main/java/frc/robot/RobotContainer.java

Lines changed: 0 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -67,7 +67,6 @@
6767
import frc.robot.subsystems.drive.Drive;
6868
import frc.robot.subsystems.drive.GyroIO;
6969
import frc.robot.subsystems.drive.GyroIOPigeon2;
70-
import frc.robot.subsystems.drive.GyroIOQuest;
7170
import frc.robot.subsystems.drive.ModuleIOReplay;
7271
import frc.robot.subsystems.drive.ModuleIOSim;
7372
import frc.robot.subsystems.drive.ModuleIOTalonFX;

src/main/java/frc/robot/subsystems/vision/MotionTrackerVision.java

Lines changed: 10 additions & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -3,14 +3,23 @@
33

44
import org.littletonrobotics.junction.Logger;
55

6+
import edu.wpi.first.math.Matrix;
67
import edu.wpi.first.math.VecBuilder;
78
import edu.wpi.first.math.geometry.Pose2d;
9+
import edu.wpi.first.math.numbers.N1;
10+
import edu.wpi.first.math.numbers.N3;
811
import edu.wpi.first.wpilibj.Alert;
912
import edu.wpi.first.wpilibj.Alert.AlertType;
1013
import edu.wpi.first.wpilibj2.command.SubsystemBase;
1114

1215
public class MotionTrackerVision extends SubsystemBase {
1316

17+
private static final Matrix<N3, N1> stdDevs = VecBuilder.fill(
18+
0.01,
19+
0.01,
20+
0.01
21+
);
22+
1423
private final TrackerIO io_;
1524
private final TrackerInputsAutoLogged inputs_;
1625

@@ -34,7 +43,7 @@ public void periodic() {
3443

3544
if (disconnected || !inputs_.isTracking) return;
3645

37-
estimateConsumer_.integrate(inputs_.pose, inputs_.timestamp, VecBuilder.fill(0.01, 0.01, 0.01));
46+
estimateConsumer_.integrate(inputs_.pose, inputs_.timestamp, stdDevs);
3847
}
3948

4049
public void setPose(Pose2d pose) {

src/main/java/frc/robot/subsystems/vision/TrackerIOQuest.java

Lines changed: 4 additions & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -10,8 +10,10 @@
1010
public class TrackerIOQuest implements TrackerIO {
1111

1212
private static final Transform2d robotToQuest = new Transform2d(
13-
Inches.of(12),
14-
Inches.of(9.25),
13+
// Inches.of(12),
14+
// Inches.of(9.25),
15+
Inches.zero(),
16+
Inches.zero(),
1517
Rotation2d.kZero
1618
);
1719

vendordeps/questnavlib.json

Lines changed: 3 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -1,19 +1,19 @@
11
{
22
"fileName": "questnavlib.json",
33
"name": "questnavlib",
4-
"version": "2025-1.0.0-beta",
4+
"version": "2025-1.0.1-beta",
55
"uuid": "a706fe68-86e5-4aed-92c5-ce05aca007f0",
66
"frcYear": "2025",
77
"mavenUrls": [
88
"https://maven.questnav.gg/releases",
99
"https://maven.questnav.gg/snapshots"
1010
],
11-
"jsonUrl": "https://maven.questnav.gg/releases/gg/questnav/questnavlib-json/2025-1.0.0-beta/questnavlib-json-2025-1.0.0-beta.json",
11+
"jsonUrl": "https://maven.questnav.gg/releases/gg/questnav/questnavlib-json/2025-1.0.1-beta/questnavlib-json-2025-1.0.1-beta.json",
1212
"javaDependencies": [
1313
{
1414
"groupId": "gg.questnav",
1515
"artifactId": "questnavlib-java",
16-
"version": "2025-1.0.0-beta"
16+
"version": "2025-1.0.1-beta"
1717
}
1818
],
1919
"cppDependencies": [],

0 commit comments

Comments
 (0)