Introduction - If you have any usage issues, please Google them yourself
Procedures will include: 1. MyInit.m initialization data output parameters: XTrueZ target the real target trajectory Z0 sampling period T observed value Q system error array DeltaR distance error DeltaSita azimuth error DeltaBeta pitch angle error totaltime exercise time montimes the number of Monte-Carlo simulation 2. EKF.m [Z1] = EKF Z1: Output EKF filtered results 3. CMKF.m [Z2] = CMKF Z2: Output CMKF filtered results 4. GetR.m CMKF algorithm for the calculation of error R array 5. CompareEandC.m EKF and CMKF, least-squares filtering Comparison of part of the drawing code after the failure, specifically the results of experimental work, see the signal. Doc document 6. source.m generate the data with outliers 7. RemoveWilddata.m outliers removed Algorithm