This Project is implementing LQR for following and trajectory creation based on robot kinematic and dynamic models