Merge branch 'main' of https://demerso.net/pls5618/2023/robot

src/main/java/frc/robot/commands/limelight.java

@@ -1,32 +0,0 @@
-// 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.commands;
-
-import edu.wpi.first.wpilibj2.command.CommandBase;
-
-public class limelight extends CommandBase {
-  /** Creates a new limelight. */
-  public limelight() {
-    // Use addRequirements() here to declare subsystem dependencies.
-  }
-
-  // Called when the command is initially scheduled.
-  @Override
-  public void initialize() {}
-
-  // Called every time the scheduler runs while the command is scheduled.
-  @Override
-  public void execute() {}
-
-  // Called once the command ends or is interrupted.
-  @Override
-  public void end(boolean interrupted) {}
-
-  // Returns true when the command should end.
-  @Override
-  public boolean isFinished() {
-    return false;
-  }
-}

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

@@ -4,11 +4,29 @@
 
 package frc.robot.subsystems;
 
+import org.photonvision.PhotonCamera;
+import org.photonvision.common.hardware.VisionLEDMode;
+
+import edu.wpi.first.net.PortForwarder;
 import edu.wpi.first.wpilibj2.command.SubsystemBase;
 
+
 public class Limelight extends SubsystemBase {
+  PhotonCamera limelight = new PhotonCamera("limelight");
   /** Creates a new Limelight. */
-  public Limelight() {}
+  public Limelight() {
+    PortForwarder.add(5800, "photonvision.local", 5800);
+  }
+
+  public void cube()  {
+    limelight.setLED(VisionLEDMode.kOff);
+    limelight.setPipelineIndex(3);
+  }
+
+  public void Cone() {
+    limelight.setLED(VisionLEDMode.kOff);
+    limelight.setPipelineIndex(2);
+  }
 
   @Override
   public void periodic() {