package Ġuk . n hs . kal man 1 d . internal . transformers Ċ Ċ import Ġuk . n hs . kal man 1 d . internal .* Ċ import Ġuk . n hs . kal man 1 d . internal . Observation Ċ import Ġuk . n hs . kal man 1 d . internal . Observation Co variance Ċ import Ġuk . n hs . kal man 1 d . internal . Observation Sigma Points Ċ import Ġuk . n hs . kal man 1 d . internal . Weights Ċ Ċ /** Ċ Ġ* ĠOb servation Transformer Ġcomputes Ġthe Ġmean Ġand Ġcovariance Ġof Ġsigma Ġpoints Ġafter Ġthey 've Ġbeen Ġpropag ated Ċ Ġ* Ġthrough Ġa Ġmeasurement Ġfunction . ĠThe Ġcross - co variance Ġbetween Ġstate Ġand Ġoutput Ġis Ġalso Ġcomputed . Ċ Ġ*/ Ċ internal Ġclass ĠOb servation Transformer ( ĊĠĠĠ Ġprivate Ġval Ġweights : ĠWe ights , ĊĠĠĠ Ġprivate Ġval Ġsigma Points Propag ator : ĠS igma Points Propag ator < Observation Sigma Points > Ċ ) Ġ{ ĊĠĠĠ Ġprivate Ġval Ġun sc ent ed Transformer Ġ= ĠUn sc ent ed Transformer < Observation , ĠOb servation Co variance >( weights ) ĊĊĠĠĠ Ġ/** ĊĠĠĠĠ Ġ* ĠThe Ġmean , Ġcovariance Ġand Ġcross - co variance Ġare Ġcomputed Ġas Ġfollows : ĊĠĠĠĠ Ġ* ĊĠĠĠĠ Ġ* Ġobservation Mean Ġ= Ġsum _{ p Ġ= Ġh ( sigma Ġpoint )} Ġmean Weight _ p Ġ* Ġp ĊĠĠĠĠ Ġ* Ġobservation Co variance Ġ= Ġsum _{ q Ġ= Ġh ( sigma Ġpoint )} Ġcovariance Weight _ q Ġ( q Ġ- Ġobservation Mean )^ 2 ĊĠĠĠĠ Ġ* Ġcross - co variance Ġ= Ġsum _{ p Ġ= Ġsigma Ġpoint } Ġcovariance Weight _ p Ġ( p Ġ- Ġstate Mean ) Ġ( h ( p ) Ġ- Ġobservation Mean ) ĊĠĠĠĠ Ġ* ĊĠĠĠĠ Ġ* Ġwhere Ġh Ġstands Ġfor Ġthe Ġobservation Ġtransformation . ĊĠĠĠĠ Ġ*/ ĊĠĠĠ Ġfun Ġtransform ( ĊĠĠĠĠĠĠĠ Ġstate : ĠState , ĊĠĠĠĠĠĠĠ Ġstate Sigma Points : ĠVector < State Sigma Points >, ĊĠĠĠĠĠĠĠ Ġobservation Sigma Points : ĠVector < Observation Sigma Points > ĊĠĠĠ Ġ): ĠOb servation Prediction Ġ{ ĊĊĠĠĠĠĠĠĠ Ġval Ġobservation Points Ġ= Ġsigma Points Propag ator . propagate ( state Sigma Points , Ġobservation Sigma Points ) ĊĠĠĠĠĠĠĠ Ġval Ġobservation Prediction Ġ= Ġun sc ent ed Transformer . transform ( observation Points ) ĊĊĠĠĠĠĠĠĠ Ġval Ġcross Co variance : ĠDouble Ġ= ĊĠĠĠĠĠĠĠĠĠĠĠ Ġstate Sigma Points ĊĠĠĠĠĠĠĠĠĠĠĠĠĠĠĠ Ġ. map Ġ{ Ġit Ġ- Ġstate . mean . raw Value Ġ} ĊĠĠĠĠĠĠĠĠĠĠĠĠĠĠĠ Ġ. multiply ( weights . co variance Weights ) ĊĠĠĠĠĠĠĠĠĠĠĠĠĠĠĠ Ġ. dot Product ( observation Points . map Ġ{ Ġit Ġ- Ġobservation Prediction . mean . raw Value Ġ}) ĊĊĠĠĠĠĠĠĠ Ġreturn ĠOb servation Prediction ( ĊĠĠĠĠĠĠĠĠĠĠĠ Ġobservation Prediction , ĊĠĠĠĠĠĠĠĠĠĠĠ ĠValue ( cross Co variance ) ĊĠĠĠĠĠĠĠ Ġ) ĊĠĠĠ Ġ} Ċ } Ċ Ċ internal Ġdata Ġclass ĠOb servation Prediction ( ĊĠĠĠ Ġval Ġstate : ĠOb servation State , ĊĠĠĠ Ġval Ġcross Co variance : ĠValue < Observation Co variance >) Ċ