Real-Time On-Orbit Estimation Method for Microthruster Thrust Based on High-Precision Orbit Determination

Algorithm 2

Pseudocode of the cubature Kalman filter process.

(1) Compute

(2) Input: , ,

(3) fortodo

(4) chol ;

(5) forto 2ndo

(6) Calculate using , , , ;

(7) ;

(8) end

(9) ;

(10) ;

(11) ;

(12) forto 2ndo

(13) Calculate using , , , ;

(14) ;

(15) end

(16) ;

(17) ;

(18) ;

(19) ;

(20) ;

(21) ;

(22) end

(23) Output: ,