Any good reference for implementing model predictive control (MPC)?

edit

I'm trying to implement MPC in ros1 and some references would be helpful.

I have a trajectory optimization node that publishes discrete trajectories (64 waypoints) at 20Hz and I plan to have another node for trajectory tracking. The trajectory tracking node will track whatever trajectory is available at the given moment. Any pointers for example implementation would be super helpful!