// 更新步骤void update(double measurement) {// 计算卡尔曼增益double K = P / (P + R);// 根据观测值更新估算值x = x + K * (measurement - x