https://123dok.net/document/zlglde76-pocp-a-package-for-polynomial-optimal-control-problems.html