klaman滤波算法的matlab编程,主要用于gps定位,具有非常好的参考价值,运行通过

				function ret = sat(s,L,U)				% This is the saturation function.  				%				%       { U: s >= U				%  ret ={ s				%       { L: s 				%  				% ret = sat(s,L,U)								n = length(s);								[N,M] = size(s);				ret = zeros(N,M);				for j=1:n					if s(j) 				   	ret(j) = L(j);					elseif s(j) >= U(j)				    	ret(j) = U(j);					else				    	ret(j) = s(j);				    end				 end