s'enligner avec un apriltag fini
This commit is contained in:
@@ -22,19 +22,6 @@ public class Limelight3 extends SubsystemBase {
|
||||
PortForwarder.add(port, "limelight.local", port);
|
||||
}
|
||||
}
|
||||
double previousValue = 0;
|
||||
double previousTime = Timer.getFPGATimestamp();
|
||||
|
||||
public double derive(double currentValue) {
|
||||
double previousValue = 0;
|
||||
double previousTime = Timer.getFPGATimestamp();
|
||||
double now = Timer.getFPGATimestamp();
|
||||
double dt = now - previousTime;
|
||||
double derivative = (currentValue - previousValue) / dt;
|
||||
previousValue = currentValue;
|
||||
previousTime = now;
|
||||
return derivative;
|
||||
}
|
||||
public double[] getTargetPose(){
|
||||
NetworkTable limelightTable = NetworkTableInstance.getDefault().getTable("limelight-balon");
|
||||
NetworkTableEntry targetPoseEntry = limelightTable.getEntry("targetpose_cameraspace");
|
||||
|
||||
Reference in New Issue
Block a user