MPC-Control:MPC算法控制车辆的运动轨迹

MPC控制 对于审稿人： MPC模型的详细信息。 初始状态和参考轨迹 Eigen::MatrixXd transformGlobal2Vehicle ( double x, double y, double psi, const vector< double> & ptsx, const vector< double> & ptsy) { assert (ptsx. size () == ptsy. size ()); unsigned len = ptsx. size (); auto waypoints = Eigen::MatrixXd ( 2 , len); for ( auto i = 0 ; i < len; ++i) { waypoints ( 0 , i) = cos (psi) * (ptsx[i] - x) + sin (psi) * (pts