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

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

通讯/手机编程

开发平台：

Matlab

limda_est.m：源码内容
  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);
  26. % 
  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=5*1e3;
  42.             flag=0;
  43.             down=-1e10; nf=0;
  44.             while flag==0
  45.                 nf=nf+1
  46.                 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);
  47.                 up=down+step;
  48.                 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);
  50.                 if fdown*fup<0
  51.                     flag=1;
  52.                 end
  53.                 if fdown*fup>0
  54.                     down=down+step;
  55.                     up=down+step;
  56.                 end                
  57.             end
  58.         %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  59.         
  60.           inter=[down up];
  61. %           inter=[-M 0];
  62.           err=inf;
  63.           au=[];bu=[];
  64.           au=inter(1);bu=inter(2);
  65.           num=0;
  66.           while err> 1e-4 && num<1e4
  67.               num=num+1;
  68.               
  69.               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);
  70.               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);
  71.               if fau*fbu<0
  72.                   cu=(au+bu)/2;
  73.                   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);
  74.                   if fcu<0
  75.                       bu=cu;
  76.                   else
  77.                       au=cu;
  78.                   end
  79.               end
  80.               err=abs(au-bu);
  81.           end
  82.           limda=cu;        
  83.  %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
  84.             6;