Add end method to FollowPath

- Joshua B

Author: ysc-josh

src/main/java/frc/robot/commands/FollowPath.java

@@ -234,7 +234,13 @@ public void execute() {
 
     @Override
     public void end(boolean isInterrupted) {
-
+        mDrivetrain.Drive(
+            Units.MetersPerSecond.of(0),
+            Units.MetersPerSecond.of(0),
+            Units.RadiansPerSecond.of(0),
+            true,
+            Milliseconds.of(20)
+        );
     }
 
     @Override