generateForwardProfile
fun generateForwardProfile(disps: List<Double>, beginVel: Double, maxVels: List<Double>, maxAccels: List<Double>): DisplacementProfile
Generates a forward displacement profile by enforcing velocity and acceleration constraints. Uses a greedy approach to maximize velocity while respecting constraints.
Return
Forward displacement profile
Parameters
disps
Displacement interval endpoints
beginVel
Beginning velocity (non-negative)
maxVels
Maximum velocities at each displacement (all positive)
maxAccels
Maximum accelerations at each displacement (all positive)