Skip to content

Commit 295adf4

Browse files
committed
add Pose 3d logger?
@GalexY727 i mist be going insane but where do we log our robot pose
1 parent b2e8698 commit 295adf4

File tree

2 files changed

+23
-1
lines changed

2 files changed

+23
-1
lines changed

src/main/java/frc/robot/subsystems/Swerve.java

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -99,7 +99,7 @@ public Swerve() {
9999
public void periodic() {
100100

101101
Update the poseEstimator using the current timestamp (from DriverUI.java), the gyro angle, and the current module states
102-
102+
103103
if (FieldConstants.IS_SIMULATION) {
104104

105105
for (MAXSwerveModule mod : swerveModules) {
Lines changed: 22 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -0,0 +1,22 @@
1+
package frc.robot.util;
2+
3+
import edu.wpi.first.math.geometry.Pose3d;
4+
import io.github.oblarg.oblog.Logger;
5+
import io.github.oblarg.oblog.annotations.Log;
6+
7+
public class Pose3dLogger extends Logger{
8+
@Log
9+
private Pose3d pose = new Pose3d();
10+
11+
public Pose3dLogger(Pose3d pose) {
12+
this.pose = pose;
13+
}
14+
15+
public Pose3d getPose() {
16+
return this.pose;
17+
}
18+
19+
public void setPose(Pose3d pose) {
20+
this.pose = pose;
21+
}
22+
}

0 commit comments

Comments
 (0)