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
2023-01-09 21:43:10
4.95MB
C++
1