b站视频中用到的代码,欢迎大家批评指正。具体代码请参考PyMPC,包含了基于线性不等式组的多面体类、MPC类和tube based MPC类的实现。