最適レギュレータ LQR (Linear-quadratic regulator) をC++で書いてみた - Qiita
ファクターグラフを使ったLQR
Google Colab