Nonlinear trajectory generator for motion control systems