开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 通讯/手机编程 > 查看源码
limda_est.asv
资源名称：TOA_uwb.rar　[点击查看]
上传用户：doryuen
上传日期：2013-10-30
资源大小：23k
文件大小：3k
源码类别：

通讯/手机编程

开发平台：

Matlab

limda_est.asv：源码内容
  1. function limda=limda_est(A,b,p,q)
  2. %
  3. %
  4. %
  5.  
  6. %         M=1e6; cn=0;
  7. %         for t=M:1:5*M
  8. %             cn=cn+1;
  9. %               f(cn)=q'*inv(A'*A+t*p)*(A'*b-0.5*t*q)+(inv(A'*A+t*p)*(A'*b-0.5*t*q))'*p*inv(A'*A+t*p)*(A'*b-0.5*t*q);
  10. %         end
  11. %         t=M:1:5*M;
  13.         
  14.         
  15.  %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  16.             M=1e7;
  17.           inter=[0 M];
  18.           err=inf;
  19.           au=[];bu=[];
  20.           au=inter(1);bu=inter(2);
  21.           num=0;
  22.           while err> 1e-4 && num<1e4
  23.               num=num+1;
  24.               fau=q'*inv(A'*A+au*p)*(A'*b-0.5*au*q)+(inv(A'*A+au*p)*(A'*b-0.5*au*q))'*p*inv(A'*A+au*p)*(A'*b-0.5*au*q);
  25.               fbu=q'*inv(A'*A+bu*p)*(A'*b-0.5*bu*q)+(inv(A'*A+bu*p)*(A'*b-0.5*bu*q))'*p*inv(A'*A+bu*p)*(A'*b-0.5*bu*q);
  27.               if fau*fbu<0
  28.                   cu=(au+bu)/2;
  29.                   fcu=q'*inv(A'*A+cu*p)*(A'*b-0.5*cu*q)+(inv(A'*A+cu*p)*(A'*b-0.5*cu*q))'*p*inv(A'*A+cu*p)*(A'*b-0.5*cu*q);
  30.                   if fcu<0
  31.                       au=cu;
  32.                   else
  33.                       bu=cu;
  34.                   end
  35.               end
  36.               err=abs(au-bu);
  37.           end
  38.           
  40.         %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  41. %             step=1e3;
  42. %             flag=0;
  43. %             down=-1e7;
  44. %             while flag==0
  45. %                 fdown=q'*inv(A'*A+down*p)*(A'*b-0.5*down*q)+(inv(A'*A+down*p)*(A'*b-0.5*down*q))'*p*inv(A'*A+down*p)*(A'*b-0.5*down*q);
  46. %                 up=down+step;
  47. %                 fup=q'*inv(A'*A+up*p)*(A'*b-0.5*up*q)+(inv(A'*A+up*p)*(A'*b-0.5*up*q))'*p*inv(A'*A+up*p)*(A'*b-0.5*up*q);
  48. % 
  49. %                 if fdown*fup<0
  50. %                     flag=1;
  51. %                 end
  52. %                 if fdown*fup>0
  53. %                     down=down+step;
  54. %                     up=down+step;
  55. %                 end                
  56. %             end
  57.         %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  58.         
  59.           inter=[-M 0];
  60.           err=inf;
  61.           au=[];bu=[];
  62.           au=inter(1);bu=inter(2);
  63.           num=0;
  64.           while err> 1e-4 && num<1e4
  65.               num=num+1;
  66.               
  67.               fau=q'*inv(A'*A+au*p)*(A'*b-0.5*au*q)+(inv(A'*A+au*p)*(A'*b-0.5*au*q))'*p*inv(A'*A+au*p)*(A'*b-0.5*au*q);
  68.               fbu=q'*inv(A'*A+bu*p)*(A'*b-0.5*bu*q)+(inv(A'*A+bu*p)*(A'*b-0.5*bu*q))'*p*inv(A'*A+bu*p)*(A'*b-0.5*bu*q);
  69.               if fau*fbu<0
  70.                   cu=(au+bu)/2;
  71.                   fcu=q'*inv(A'*A+cu*p)*(A'*b-0.5*cu*q)+(inv(A'*A+cu*p)*(A'*b-0.5*cu*q))'*p*inv(A'*A+cu*p)*(A'*b-0.5*cu*q);
  72.                   if fcu<0
  73.                       bu=cu;
  74.                   else
  75.                       au=cu;
  76.                   end
  77.               end
  78.               err=abs(au-bu);
  79.           end
  80.           limda=cu;        
  81.  %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  82.             6;