8 implement lqr controller#10

rdesarz wants to merge 26 commits intomainrdesarz/control-sys-rs:mainfrom

8-implement-lqr-controllerrdesarz/control-sys-rs:8-implement-lqr-controllerCopy head branch name to clipboard