Expose photonVision classes
This commit is contained in:
parent
4e5588d2a8
commit
fde77e106c
|
|
@ -4,7 +4,7 @@ apply plugin: 'maven-publish'
|
|||
|
||||
ext.licenseFile = files("$rootDir/LICENSE.txt")
|
||||
|
||||
def pubVersion = '2023.3.2'
|
||||
def pubVersion = '2023.3.3'
|
||||
|
||||
def outputsFolder = file("$buildDir/allOutputs")
|
||||
|
||||
|
|
|
|||
|
|
@ -11,13 +11,12 @@ import org.photonvision.EstimatedRobotPose;
|
|||
import edu.wpi.first.apriltag.AprilTagFieldLayout;
|
||||
import edu.wpi.first.apriltag.AprilTagFields;
|
||||
import edu.wpi.first.math.geometry.Pose2d;
|
||||
import edu.wpi.first.apriltag.AprilTagFieldLayout.OriginPosition;
|
||||
import edu.wpi.first.apriltag.AprilTagFieldLayout.OriginPosition;
|
||||
import edu.wpi.first.math.geometry.Transform3d;
|
||||
|
||||
public class RobotFieldPosition {
|
||||
AprilTagFieldLayout layout;
|
||||
PhotonPoseEstimator photonPoseEstimator;
|
||||
PhotonCamera camera;
|
||||
Optional<EstimatedRobotPose> frozenPose;
|
||||
boolean frozen = false;
|
||||
|
||||
|
|
@ -46,8 +45,6 @@ public class RobotFieldPosition {
|
|||
public RobotFieldPosition(String camera, Transform3d robotToCam, AprilTagFields fields) throws IOException {
|
||||
layout = AprilTagFieldLayout.loadFromResource(fields.m_resourceFile);
|
||||
|
||||
layout.setOrigin(OriginPosition.kBlueAllianceWallRightSide);
|
||||
|
||||
PhotonCamera cam = new PhotonCamera(camera);
|
||||
photonPoseEstimator = new PhotonPoseEstimator(layout, PoseStrategy.LOWEST_AMBIGUITY, cam, robotToCam);
|
||||
}
|
||||
|
|
@ -74,6 +71,14 @@ public class RobotFieldPosition {
|
|||
photonPoseEstimator.setLastPose(pose);
|
||||
}
|
||||
|
||||
public PhotonPoseEstimator getPhotonPoseEstimator(){
|
||||
return photonPoseEstimator;
|
||||
}
|
||||
|
||||
public PhotonCamera getPhotonCamera(){
|
||||
return camera;
|
||||
}
|
||||
|
||||
// For when you want it to stay the same across lines
|
||||
public void freeze() {
|
||||
frozen = true;
|
||||
|
|
@ -85,4 +90,4 @@ public class RobotFieldPosition {
|
|||
}
|
||||
|
||||
|
||||
}
|
||||
}
|
||||
|
|
|
|||
Loading…
Reference in New Issue