found the tag issue

- the huskey lens was looking for tag 1, when i only needeed A tag
- we wrote true in the if statement so that it always runs the april tag code

Author: SugarDulcePan

TeamCode/src/main/java/org/mrpsvt/capital_robotics/auto/Blue_close_w_huskey.java

@@ -169,10 +169,11 @@ private void autonomousSequence() throws InterruptedException
        sleep(3000);
         */
 
-
+        /*
         telemetry.addData("Step", "6: Strafing right");
         telemetry.update();
         driveDistance(0, 1.5, 0, 700);
+         */
 
 
         telemetry.addData("Status", "Autonomous Complete");

TeamCode/src/main/java/org/mrpsvt/capital_robotics/auto/husky_method.java

@@ -60,7 +60,7 @@ public void homingLens()
         // Look for our target tag
         for (HuskyLens.Block block : blocks)
         {
-            if (block.id == TARGET_TAG_ID)
+            if (block.id == TARGET_TAG_ID || true)
             {
                 targetFound = true;
 
@@ -90,7 +90,7 @@ public void homingLens()
                     telemetry.addData("action", "triangulating x");
                     if (tagX > x && change == 0)
                     {
-                        driveDistance(0, .5, 0, 400);
+                        driveDistance(0, .4, 0, 400);
                         tagX = block.x;
                         if (tagX < x)
                         {
@@ -100,7 +100,7 @@ public void homingLens()
                     }
                     else if (tagX > x && change > 1)
                     {
-                        driveDistance(0, .5 * Math.pow(.75, change), 0, (long) (400 * Math.pow(.75, change)));
+                        driveDistance(0, .4, 0, (long) (400 * Math.pow(.75, change)));
                         tagX = block.x;
                         if (tagX < x)
                         {
@@ -110,7 +110,7 @@ else if (tagX > x && change > 1)
                     }
                     else if (tagX < x && change == 0)
                     {
-                        driveDistance(0, -.5, 0, 400);
+                        driveDistance(0, -.4, 0, 400);
                         tagX = block.x;
                         if (tagX > x)
                         {
@@ -120,7 +120,7 @@ else if (tagX < x && change == 0)
                     }
                     else if (tagX < x && change > 1)
                     {
-                        driveDistance(0, -.5 * Math.pow(.75, change), 0, (long) (400 * Math.pow(.75, change)));
+                        driveDistance(0, -.4, 0, (long) (400 * Math.pow(.75, change)));
                         tagX = block.x;
                         if (tagX > x)
                         {