Skip to content

Commit

Permalink
started base code
Browse files Browse the repository at this point in the history
  • Loading branch information
HeeistHo committed Jun 27, 2023
1 parent 518e94f commit f9dd838
Show file tree
Hide file tree
Showing 2 changed files with 48 additions and 0 deletions.
48 changes: 48 additions & 0 deletions src/main/java/frc/robot/subsystems/PhotonBack.java
Original file line number Diff line number Diff line change
@@ -0,0 +1,48 @@
// Copyright (c) FIRST and other WPILib contributors.
// Open Source Software; you can modify and/or share it under the terms of
// the WPILib BSD license file in the root directory of this project.

package frc.robot.subsystems;

import org.photonvision.PhotonCamera;
import org.photonvision.targeting.PhotonPipelineResult;

import edu.wpi.first.wpilibj2.command.CommandScheduler;
import edu.wpi.first.wpilibj2.command.SubsystemBase;

public class PhotonBack extends SubsystemBase {

public String photonName;
PhotonCamera cam = new PhotonCamera(photonName);
boolean hasTarget = false;

/** Creates a new PhotonBack. */
public PhotonBack(String photonName) {
this.photonName = photonName;

CommandScheduler.getInstance().registerSubsystem(this);
}

@Override
public void periodic() {
// This method will be called once per scheduler run
}


public PhotonPipelineResult getPipelineResult() {
return cam.getLatestResult();
}

public double getYaw(){
return getPipelineResult().getBestTarget().getYaw();
}

public double getPitch(){
return getPipelineResult().getBestTarget().getPitch();
}

public double getSkew(){
return getPipelineResult().getBestTarget().getSkew();
}

}
Empty file.

0 comments on commit f9dd838

Please sign in to comment.