function StatDeviation(rVolt,SEVolt,rVAngel,SEVAngel,sigma) t1=[rVolt;rVAngel]; t2=[SEVolt;SEVAngel]; t3=sum((t2-t1).^2)/length(t1); t3=t3.^0.5; fprintf('状态量统计误差 %f\n',full(t3)); t1=[rVolt]; t2=[SEVolt]; t3=sum( ( (t2-t1)./(rVolt.*sigma) ).^2 )/length(t1); t3=t3.^0.5; fprintf('量测量统计误差 %f\n',full(t3)); end