mirror of
https://github.com/Team4388/2023WayOfTheRobot.git
synced 2026-06-09 00:37:59 -06:00
lime stuff
This commit is contained in:
@@ -142,4 +142,19 @@ public final class Constants {
|
|||||||
public static final double RIGHT_AXIS_DEADBAND = 0.6;
|
public static final double RIGHT_AXIS_DEADBAND = 0.6;
|
||||||
public static final boolean SKEW_STICKS = true; // ! this might have to actually be false, merge conflicts are confusing
|
public static final boolean SKEW_STICKS = true; // ! this might have to actually be false, merge conflicts are confusing
|
||||||
}
|
}
|
||||||
|
|
||||||
|
public static final class VisionConstants {
|
||||||
|
public static final String NAME = "Aarav is poopy";
|
||||||
|
|
||||||
|
public static final int LIME_FOV = -1;
|
||||||
|
|
||||||
|
public static final double LIME_HEIGHT = -1.0;
|
||||||
|
public static final double LIME_ANGLE = -1.0;
|
||||||
|
|
||||||
|
public static final double HIGH_TARGET_HEIGHT = -1.0;
|
||||||
|
public static final double HIGHT_TAPE_HEIGHT = -1.0;
|
||||||
|
|
||||||
|
public static final double MID_TARGET_HEIGHT = -1.0;
|
||||||
|
public static final double MID_TAPE_HEIGHT = -1.0;
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -0,0 +1,53 @@
|
|||||||
|
// 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 frc4388.robot.subsystems;
|
||||||
|
|
||||||
|
import java.util.ArrayList;
|
||||||
|
import java.util.List;
|
||||||
|
|
||||||
|
import org.opencv.core.Point;
|
||||||
|
import org.photonvision.PhotonCamera;
|
||||||
|
import org.photonvision.common.hardware.VisionLEDMode;
|
||||||
|
import org.photonvision.targeting.PhotonPipelineResult;
|
||||||
|
import org.photonvision.targeting.TargetCorner;
|
||||||
|
|
||||||
|
import edu.wpi.first.wpilibj2.command.SubsystemBase;
|
||||||
|
import frc4388.robot.Constants.VisionConstants;
|
||||||
|
import frc4388.utility.AbhiIsADumbass;
|
||||||
|
|
||||||
|
public class Limelight extends SubsystemBase {
|
||||||
|
private PhotonCamera cam;
|
||||||
|
/** Creates a new LImelight. */
|
||||||
|
public Limelight() {
|
||||||
|
cam = new PhotonCamera(VisionConstants.NAME);
|
||||||
|
}
|
||||||
|
|
||||||
|
public void setLEDs(boolean on) {
|
||||||
|
cam.setLED(on ? VisionLEDMode.kOn : VisionLEDMode.kOff);
|
||||||
|
}
|
||||||
|
|
||||||
|
public void setDriverMode(boolean driverMode) {
|
||||||
|
cam.setDriverMode(driverMode);
|
||||||
|
}
|
||||||
|
|
||||||
|
public Point getTargetPoints() throws AbhiIsADumbass {
|
||||||
|
PhotonPipelineResult result = cam.getLatestResult();
|
||||||
|
|
||||||
|
if (!result.hasTargets()) throw new AbhiIsADumbass();
|
||||||
|
|
||||||
|
Point point = new Point();
|
||||||
|
List<TargetCorner> corners = result.getTargets().get(0).getDetectedCorners();
|
||||||
|
|
||||||
|
double x1, x2, y1, y2;
|
||||||
|
double mx, my;
|
||||||
|
|
||||||
|
return new Point(mx, my);
|
||||||
|
}
|
||||||
|
|
||||||
|
@Override
|
||||||
|
public void periodic() {
|
||||||
|
// This method will be called once per scheduler run
|
||||||
|
}
|
||||||
|
}
|
||||||
@@ -0,0 +1,41 @@
|
|||||||
|
{
|
||||||
|
"fileName": "photonlib.json",
|
||||||
|
"name": "photonlib",
|
||||||
|
"version": "v2023.4.2",
|
||||||
|
"uuid": "515fe07e-bfc6-11fa-b3de-0242ac130004 ",
|
||||||
|
"mavenUrls": [
|
||||||
|
"https://maven.photonvision.org/repository/internal",
|
||||||
|
"https://maven.photonvision.org/repository/snapshots"
|
||||||
|
],
|
||||||
|
"jsonUrl": "https://maven.photonvision.org/repository/internal/org/photonvision/PhotonLib-json/1.0/PhotonLib-json-1.0.json",
|
||||||
|
"jniDependencies": [],
|
||||||
|
"cppDependencies": [
|
||||||
|
{
|
||||||
|
"groupId": "org.photonvision",
|
||||||
|
"artifactId": "PhotonLib-cpp",
|
||||||
|
"version": "v2023.4.2",
|
||||||
|
"libName": "Photon",
|
||||||
|
"headerClassifier": "headers",
|
||||||
|
"sharedLibrary": true,
|
||||||
|
"skipInvalidPlatforms": true,
|
||||||
|
"binaryPlatforms": [
|
||||||
|
"windowsx86-64",
|
||||||
|
"linuxathena",
|
||||||
|
"linuxx86-64",
|
||||||
|
"osxuniversal"
|
||||||
|
]
|
||||||
|
}
|
||||||
|
],
|
||||||
|
"javaDependencies": [
|
||||||
|
{
|
||||||
|
"groupId": "org.photonvision",
|
||||||
|
"artifactId": "PhotonLib-java",
|
||||||
|
"version": "v2023.4.2"
|
||||||
|
},
|
||||||
|
{
|
||||||
|
"groupId": "org.photonvision",
|
||||||
|
"artifactId": "PhotonTargeting-java",
|
||||||
|
"version": "v2023.4.2"
|
||||||
|
}
|
||||||
|
]
|
||||||
|
}
|
||||||
Reference in New Issue
Block a user