Added a simple example of a LQR trajectory tracking controller