Implemented a LQR controller with computed gains from a non-linear program solver for an agent to follow a given trajectory.

This starter code was tested with: python 3.7, matplotlib 3.4, and numpy 1.20.

Main file, computes optimal gains for agent using a NLP solver and uses them as control input for agent.

This file contains code to visualize the desired trajectory, car's trajectory and obstacles.