evaluateConstraintsAtSamples
fun evaluateConstraintsAtSamples(path: PosePath, samples: List<Double>, velConstraint: VelConstraint, accelConstraint: AccelConstraint): Pair<List<Double>, List<Double>>
Evaluates velocity and acceleration constraints at the given sample points. Returns maximum velocities and accelerations for forward profile generation.