slam_in_autonomous_driving
slam_in_autonomous_driving copied to clipboard
ch3,eskf.hpp中ObserveWheelSpeed函数的 dx_ = K * (vel_world - v_);步骤左右两侧维度不同吧,一个是18维,一个是3维,怎么相乘的呢,而且乘完的结果又是怎么用UpdateAndReset更新给所有误差量的呢