This Project is implementing LQR for following and trajectory creation based on robot kinematic and dynamic models
SIA - C++/Python library for model-based stochastic estimation and optimal control
