基于分布式驱动电动汽车的路面附着系数估计，分别采用无迹卡尔曼 滤波（UKF）和容积卡尔曼滤波（CKF）对电动汽车四个车轮的路面附着系数进行估计。 可在高速，低速下，对开路面，对接路面四种组合工况下对路面附着系数进行准确估计估计。 该模型的两种估计算法均由S-function编写，可比较二种滤波的估计效果。

分布式驱动电动汽车的轮子底下藏着大学问。今儿咱们聊聊怎么用无迹卡尔曼滤波（UKF）和容积卡尔曼滤波（CKF）来扒开车轮与地面之间的那层"神秘关系"——路面附着系数。这玩意儿直接影响着车辆稳定性控制，特别是遇到对开路面（左右轮摩擦系数不同）或者对接路面（前后轮摩擦系数突变）这种坑爹工况时。

先看段S-function里的状态初始化代码：

function sys=mdlInitializeSizes
    sizes.NumContStates = 0;
    sizes.NumDiscStates = 4;  % 四个轮的附着系数
    sizes.NumOutputs = 8;     % 包含估计值和观测噪声
    sizes.NumInputs = 6;      % 轮速、电机扭矩等
    sizes.DirFeedthrough = 1;
    sys = simsizes(sizes);

这里藏着个小细节：把附着系数作为离散状态而不是连续状态来处理。实际调试中发现，当车速飙到120km/h时，连续状态容易产生数值震荡，离散化后反而更稳定。

核心算法部分，两种滤波器都用了类似的状态方程结构：

static void state_update(double* x, const double* u, double dt) {
    // 动力学模型简化为指数衰减过程
    for(int i=0; i<4; i++){
        x[i] = x[i] * exp(-dt/TAU) + 0.02*(rand()/(double)RAND_MAX-0.5);
    }
}

这个TAU参数是个调参玄学，实测在冰面工况下设为0.5秒，沥青路面则要1.2秒左右。注意那个故意加的随机扰动项，这是为了防止滤波器过度自信——现实中的路面可不会按剧本走。

基于分布式驱动电动汽车的路面附着系数估计，分别采用无迹卡尔曼 滤波（UKF）和容积卡尔曼滤波（CKF）对电动汽车四个车轮的路面附着系数进行估计。 可在高速，低速下，对开路面，对接路面四种组合工况下对路面附着系数进行准确估计估计。 该模型的两种估计算法均由S-function编写，可比较二种滤波的估计效果。

观测方程里有个骚操作：

function y = observation(x, u)
    % 利用轮胎魔术公式逆向推算
    slip_ratio = abs((u(1:4)-u(5))./max(u(5),1.0)); % 防除零
    y = x.* (1.5*sin(2.1*atan(0.7*slip_ratio)) ); 
end

这个三角函数组合可不是乱写的，它其实是Pacejka魔术公式的简化版。当年调这个式子的时候，把实验室的轮胎数据本都快翻烂了，最后发现用sin代替原公式里的三次多项式，在嵌入式系统里跑得更欢实。

跑起仿真来看效果，CKF在高动态场景下（比如从沥青路突然冲进冰面）响应快0.2秒左右，但UKF在低速蠕行工况更稳。特别是遇到那种水泥路接钢板路的变态组合，两种算法的估计曲线会像较劲似的互相拉扯，这时候取加权平均值反而能出奇效。

最后奉劝各位想复现的兄弟，别死磕理论推导。实际调试时会遇到各种妖魔鬼怪，比如电机扭矩传感器的噪声分布根本不是高斯的，这时候就得在量测更新环节加个饱和限制：

// 量测修正时防野值
for(int i=0; i<4; i++){
    innovation = z[i] - hx[i];
    innovation = fmax(fmin(innovation, 0.3), -0.3); // 硬截断
    x_hat[i] += K[i] * innovation;
}

这个0.3的阈值是用实车在试车场撞了三次护栏换来的血泪经验——别问我是怎么知道的，问就是方向盘还在抖。