Team4388/2022NoWayHome
1
0
Fork 0
mirror of https://github.com/Team4388/2022NoWayHome.git synced 2026-06-09 08:48:07 -06:00
Code Issues Packages Projects Releases Wiki Activity

make nathan's code better (he asked me to)

Browse Source
This commit is contained in:
aarav18
2022-04-08 12:42:03 -06:00
parent c7f5d66a47
commit 471bc56d54
1 changed files with 7 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/main/java/frc4388/robot/commands/ShooterCommands/TrackTarget.java
+7 -3
View File
@@ -120,9 +120,13 @@ public class TrackTarget extends CommandBase {
double regressedDistance = getDistance(average.y);
// ! offset trig solution
double desiredOffset = 10; // * inches
double angleOffset = Math.toDegrees(Math.atan(desiredOffset / regressedDistance)); // * degrees
double pixelOffset = angleOffset * VisionConstants.PIXELS_PER_DEGREE;
double trigDesiredOffset = 10; // * inches
double trigAngleOffset = Math.toDegrees(Math.atan(trigDesiredOffset / regressedDistance)); // * degrees
double trigPixelOffset = trigAngleOffset * VisionConstants.PIXELS_PER_DEGREE; // * pixels
// ! offset csv solution
double csvAngleOffset = m_boomBoom.getOffset(regressedDistance); // * degrees
double csvPixelOffset = csvAngleOffset * VisionConstants.PIXELS_PER_DEGREE; // * pixels
double output = ((average.x + 40) - VisionConstants.LIME_HIXELS/2.d) / VisionConstants.LIME_HIXELS;
output *= 2.1;