Aiming at the condition that function of error measurement is not according with contaminated distribution

the robust character of M-estimate is put for word to reckon unknown parameter and to distribute weight value according to computed uncertainty of each sensor.Simulation results prove that this algorithm has advantages on model and algorithm selection

and it has high accuracy and robustness.