|
1 | 1 | package frc.robot.subsystems.vision; |
2 | 2 |
|
3 | | -import edu.wpi.first.math.geometry.Rotation2d; |
4 | | -import edu.wpi.first.math.geometry.Translation2d; |
5 | | -import frc.robot.constants.VisionConstants; |
6 | | -import java.util.Set; |
7 | | -import org.strykeforce.telemetry.measurable.MeasurableSubsystem; |
8 | | -import org.strykeforce.telemetry.measurable.Measure; |
9 | | -import frc.robot.subsystems.drive.DriveSubsystem; |
10 | | - |
11 | | -public class VisionSubsystem extends MeasurableSubsystem { |
12 | | - |
13 | | - Translation2d[] camPositions = { |
14 | | - VisionConstants.kCam1Pose.getTranslation().toTranslation2d(), |
15 | | - VisionConstants.kCam2Pose.getTranslation().toTranslation2d(), |
16 | | - VisionConstants.kCam3Pose.getTranslation().toTranslation2d(), |
17 | | - VisionConstants.kCam4Pose.getTranslation().toTranslation2d() |
18 | | - }; |
19 | | - |
20 | | - Rotation2d[] camRotations = { |
21 | | - VisionConstants.kCam1Pose.getRotation().toRotation2d(), |
22 | | - VisionConstants.kCam2Pose.getRotation().toRotation2d(), |
23 | | - VisionConstants.kCam3Pose.getRotation().toRotation2d(), |
24 | | - VisionConstants.kCam4Pose.getRotation().toRotation2d() |
25 | | - }; |
26 | | - |
27 | | - String[] camNames = { |
28 | | - VisionConstants.kCam1Name, VisionConstants.kCam2Name, VisionConstants.kCam3Name |
29 | | - }; |
30 | | - |
31 | | - String[] piNames = { |
32 | | - VisionConstants.kPi1Name, VisionConstants.kPi2Name, VisionConstants.kPi3Name, |
33 | | - }; |
34 | | - |
35 | | - int[] camIndex = { |
36 | | - VisionConstants.kCam1Idx, |
37 | | - VisionConstants.kCam2Idx, |
38 | | - VisionConstants.kCam3Idx, |
39 | | - VisionConstants.kCam4Idx |
40 | | - }; |
41 | | - |
42 | | - public VisionSubsystem(DriveSubsystem driveSubsystem) { |
43 | | - |
44 | | - } |
45 | | - @Override |
46 | | - public Set<Measure> getMeasures() { |
47 | | - return Set.of(); |
48 | | - } |
49 | | -} |
| 3 | +public class VisionSubsystem {} |
0 commit comments