[lqr]

This paper may be interesting to you. It touches on several of the topics you mentioned:

https://www.science.org/doi/10.1126/scirobotics.abm6597