mirror of
https://github.com/Team4388/2022NoWayHome.git
synced 2026-06-09 00:38:05 -06:00
back to +40 offset
This commit is contained in:
@@ -124,7 +124,7 @@ public class TrackTarget extends CommandBase {
|
|||||||
double angleOffset = Math.toDegrees(Math.atan(desiredOffset / regressedDistance)); // * degrees
|
double angleOffset = Math.toDegrees(Math.atan(desiredOffset / regressedDistance)); // * degrees
|
||||||
double pixelOffset = angleOffset * VisionConstants.PIXELS_PER_DEGREE;
|
double pixelOffset = angleOffset * VisionConstants.PIXELS_PER_DEGREE;
|
||||||
|
|
||||||
double output = ((average.x + pixelOffset) - VisionConstants.LIME_HIXELS/2.d) / VisionConstants.LIME_HIXELS;
|
double output = ((average.x + 40) - VisionConstants.LIME_HIXELS/2.d) / VisionConstants.LIME_HIXELS;
|
||||||
output *= 2.1;
|
output *= 2.1;
|
||||||
|
|
||||||
m_turret.runTurretWithInput(output);
|
m_turret.runTurretWithInput(output);
|
||||||
|
|||||||
Reference in New Issue
Block a user