PID Controller and Trajectory Generation

I/P :
O/P :
where and are the PID controller parameters. Trajectory generator updates the controller with a new position the manipulator targets.