最適レギュレータ LQR (Linear-quadratic regulator) をC++で書いてみた - Qiita

ファクターグラフを使ったLQR

Google Colab