diff --git a/lib/src/main/java/org/fairportrobotics/frc/robolib/trajectory/ballistics/models/BallisticModel.java b/lib/src/main/java/org/fairportrobotics/frc/robolib/trajectory/ballistics/models/BallisticModel.java index d1da39a..0e91fca 100644 --- a/lib/src/main/java/org/fairportrobotics/frc/robolib/trajectory/ballistics/models/BallisticModel.java +++ b/lib/src/main/java/org/fairportrobotics/frc/robolib/trajectory/ballistics/models/BallisticModel.java @@ -46,4 +46,15 @@ public abstract class BallisticModel
{ */ public abstract Translation3d positionAtTime(Velocity3d velocity, Time time); + /** + * Check if a given parameter has had a computed velocity + * @param param The param to check + * @return true iff the parameter has had a computed solution + */ + public abstract boolean paramComputed(P param); + + /** + * Mark all params as not computed for paramComputed + */ + public abstract void paramComputedReset(); } diff --git a/lib/src/main/java/org/fairportrobotics/frc/robolib/trajectory/ballistics/models/SimpleTOFBM.java b/lib/src/main/java/org/fairportrobotics/frc/robolib/trajectory/ballistics/models/SimpleTOFBM.java index 7f3c01c..23bba3e 100644 --- a/lib/src/main/java/org/fairportrobotics/frc/robolib/trajectory/ballistics/models/SimpleTOFBM.java +++ b/lib/src/main/java/org/fairportrobotics/frc/robolib/trajectory/ballistics/models/SimpleTOFBM.java @@ -1,6 +1,7 @@ package org.fairportrobotics.frc.robolib.trajectory.ballistics.models; import java.util.ArrayList; +import java.util.HashSet; import org.fairportrobotics.frc.robolib.trajectory.Velocity3d; @@ -24,6 +25,8 @@ public class SimpleTOFBM extends ReversableRadialBM