https://9dok.net/document/q0543ddv-pod-für-linear-quadratische-optimalsteuerung-übungsblatt.html