MCPcopy Create free account
hub / github.com/OpenPTrack/open_ptrack_v2 / init

Method init

bayes/src/SIRFlt.cpp:426–451  ·  view source on GitHub ↗

Source from the content-addressed store, hash-verified

424}
425
426void 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
454void SIR_kalman_scheme::mean ()

Callers

nothing calls this directly

Calls 5

identityFunction · 0.85
UdUseperateFunction · 0.85
check_PSDMethod · 0.80
init_GqGMethod · 0.80
UdUfactorFunction · 0.70

Tested by

no test coverage detected