Predictive path parameterization for constrained robot control