File tree Expand file tree Collapse file tree 1 file changed +5
-6
lines changed
src/main/java/com/chaos131/vision Expand file tree Collapse file tree 1 file changed +5
-6
lines changed Original file line number Diff line number Diff line change @@ -221,13 +221,12 @@ protected void processUpdateQueue() {
221221 VisionData data = processMeasuredData (idx );
222222 if (data != null ) {
223223 m_poseUpdator .accept (data );
224+ Logger .recordOutput (m_name + "/PoseTimestamp" , data .getTimestampSeconds ());
225+ Logger .recordOutput (m_name + "/RobotPose" , data .getPose2d ());
226+ Logger .recordOutput (m_name + "/RobotPose3d" , data .getPose3d ());
227+ Logger .recordOutput (m_name + "/Confidence" , data .getConfidence ());
228+ Logger .recordOutput (m_name + "/Deviation" , data .getDeviation ());
224229 }
225-
226- Logger .recordOutput (m_name + "/PoseTimestamp" , data .getTimestampSeconds ());
227- Logger .recordOutput (m_name + "/RobotPose" , data .getPose2d ());
228- Logger .recordOutput (m_name + "/RobotPose3d" , data .getPose3d ());
229- Logger .recordOutput (m_name + "/Confidence" , data .getConfidence ());
230- Logger .recordOutput (m_name + "/Deviation" , data .getDeviation ());
231230 }
232231 }
233232
You can’t perform that action at this time.
0 commit comments