https://123dok.net/document/y8gpmg30-inverse-optimal-control-with-polynomial-optimization.html