cost_est.asv
资源名称:TOA_uwb.rar [点击查看]
上传用户:doryuen
上传日期:2013-10-30
资源大小:23k
文件大小:1k
源码类别:
通讯/手机编程
开发平台:
Matlab
- function [cost, theta]=cost_est(A,b,p)
- %
- %
- %
- limda=limda_est(A,b,p)
- flag(1:length(limda))=0;
- if limda(1) ~= -1
- for m=1:length(limda)
- t_theta(:,m)=inv(A'*A+limda(m)*p)*A'*b;
- if t_theta(3,m)>0
- flag(m)=1;
- end
- end
- % for m=1:length(limda)
- % if t_theta(3,m)<0 % || abs(theta(1)^2+theta(2)^2-theta(3)^2)>50
- % cost=-1;
- % theta=[-1 -1 -1]';
- % else
- % cost=(A*t_theta(:,m)-b)'*(A*t_theta(:,m)-b);
- % theta=t_theta(:,m);
- % end
- % end
- else
- theta=[-1 -1 -1]';
- cost=-1;
- end