Highway_Mpc MPC implementation on a straight highway with lane boundary and obstacle avoidance constraints. Dependencies ffmpeg cvxopt matplotlib numpy Output The video for the implementation can be seen here. It takes approx 53 ms to plan a trajectory.