A Novel Fifth-Degree Cubature Kalman Filter for Real-Time Orbit Determination by Radar

Algorithm 1

The pseudocode of the proposed algorithm. The fifth-degree cubature Kalman filter.

() Compute , and ;

() Input: , ,

() for to do

() ;

() for to do

()  Calculate using , , , and ;

()  ;

() end

() ;

() ;

() ;

() for to do

()  Calculate using , , , and ;

()  ;

() end

() ;

() ;

() ;

() ;

() ;

() ;

() end

() Output: ,