| 424 | } |
| 425 | |
| 426 | void SIR_kalman_scheme::init () |
| 427 | /* Initialise sampling from Kalman statistics |
| 428 | * Pre: x,X |
| 429 | * Post: x,X,S |
| 430 | */ |
| 431 | { |
| 432 | // Samples at mean |
| 433 | const std::size_t nSamples = S.size2(); |
| 434 | for (std::size_t i = 0; i != nSamples; ++i) { |
| 435 | FM::ColMatrix::Column Si(S,i); |
| 436 | noalias(Si) = x; |
| 437 | } |
| 438 | // Decorrelate init state noise |
| 439 | Matrix UD(x_size,x_size); |
| 440 | Float rcond = UdUfactor (UD, X); |
| 441 | rclimit.check_PSD(rcond, "Init X not PSD"); |
| 442 | |
| 443 | // Sampled predict model for initial noise variance |
| 444 | FM::identity (roughen_model.Fx); |
| 445 | UdUseperate (roughen_model.G, roughen_model.q, UD); |
| 446 | roughen_model.init_GqG (); |
| 447 | // Predict using model to apply initial noise |
| 448 | predict (roughen_model); |
| 449 | |
| 450 | SIR_scheme::init_S (); |
| 451 | } |
| 452 | |
| 453 | |
| 454 | void SIR_kalman_scheme::mean () |
nothing calls this directly
no test coverage detected