finished 5 ball

PathWeaver/Paths/FiveBallMidComplete

@@ -1,5 +1,5 @@
 X,Y,Tangent X,Tangent Y,Fixed Theta,Name
 3.2,-2.3,0.5,0.0,true,
 5.910341889267586,-1.8695488554289974,0.2974456214546777,-0.16656954801461854,true,
-6.374357058736883,-2.3097683751819202,-0.09518259886549707,-0.16656954801461987,true,
-5.85085276497665,-2.4763379231965392,-0.22605867230555443,-0.11897824858187134,true,
+6.398152708453256,-2.178892301741862,-0.09518259886549707,-0.16656954801461987,true,
+5.886546239551211,-2.3573596746146683,-0.22605867230555443,-0.11897824858187134,true,

src/main/java/frc4388/robot/Robot.java

@@ -82,6 +82,8 @@ public class Robot extends TimedRobot {
     m_robotContainer.setDriveNeutralMode(NeutralMode.Brake);
     m_robotContainer.setDriveGearState(true);
     m_robotContainer.resetOdometry(new Pose2d());
+    m_robotContainer.resetGyroYawRobotContainer(0);
+
     //m_robotContainer.configDriveTrainSensors(FeedbackDevice.IntegratedSensor);
 
     /*

src/main/java/frc4388/robot/RobotContainer.java

@@ -325,8 +325,8 @@ public class RobotContainer {
             //return m_eightBallAutoMiddle.andThen(() -> m_robotDrive.tankDriveVelocity(0, 0));
             //return m_driveOffLineForward.andThen(() -> m_robotDrive.tankDriveVelocity(0, 0));
             //return m_driveOffLineBackward.andThen(() -> m_robotDrive.tankDriveVelocity(0, 0));
-            //return m_fiveBallAutoMiddle.andThen(() -> m_robotDrive.tankDriveVelocity(0, 0));
-            return m_tenBallAutoMiddle.andThen(()-> m_robotDrive.tankDriveVelocity(0, 0));
+            return m_fiveBallAutoMiddle.andThen(() -> m_robotDrive.tankDriveVelocity(0, 0));
+            //return m_tenBallAutoMiddle.andThen(()-> m_robotDrive.tankDriveVelocity(0, 0));
 
         } catch (Exception e) {
             System.err.println("ERROR");
@@ -438,6 +438,10 @@ public class RobotContainer {
         m_robotDrive.setOdometry(pose);
     }
 
+    public void resetGyroYawRobotContainer(double angle) {
+        m_robotDrive.resetGyroYaw(angle);
+    }
+
     /**
      * Used for analog inputs like triggers and axises.
      * @return IHandController interface for the Driver Controller.

src/main/java/frc4388/robot/commands/auto/FiveBallAutoMiddle.java

@@ -22,7 +22,7 @@ public class FiveBallAutoMiddle extends SequentialCommandGroup {
     // Use addRequirements() here to declare subsystem dependencies.
     addCommands(
       paths[0],
-      new TankDriveVelocity(drive, -3.1, -0.3, 0.97)
+      new TankDriveVelocity(drive, -3.2, -0.2, 0.8)
     );
   }
 }