How to add constraint in a optimal control design?

33 Views Asked by At

When I do my project, I need add a constraint to the trajectory in a certain time within nonlinear optimal control design. For example, there are two dimensional system , x and y. I would like to set x(3) = 5 and y(3) = 6 (the time interval is [0, 5]s), which mean I want the trajectory travel (5, 6) at 3 second.

Is there any way to formulate that ?

If there are some papers or materials can be recommends , that would be great.

thanks

Jie