https://9pdf.net/document/zlge656r-robust-explicit-moving-horizon-control-and-estimation.html