非常齐全的wsn定位matlab仿真程序

clear %1.初始参数设定模块 %.传感器节点区域界限(单位 M) xm=100; ym=100; %(1)汇聚节坐标给定 sink.x=0.5*xm; sink.y=0.5*ym; %区域内传器节数 n=100 %簇头优化比例（当选簇头的概率） p=0.05; P=0.05; %能量模型（单位 焦） %初始化能量模型 Eo=0.5; %Eelec=Etx=Erx ETX=50*0.000000001; ERX=50*0.000000001; %Transmit Amplifier types Efs=10*0.000000000001; Emp=0.0013*0.000000000001; %Data Aggregation Energy EDA=5*0.000000001; %高能量节点超出一节点能量的百分比 a=1; %最大循环次数 rmax=5000 %算出参数 do do=sqrt(Efs/Emp); Et=0; %2.无线传感器网络模型产生模块 %构建无线传感器网络,在区域内均匀投放100个节点,并画出图形 for i=1:1:n S1(i).xd=rand(1,1)*xm; S2(i).xd=S1(i).xd; S3(i).xd=S1(i).xd; S4(i).xd=S3(i).xd; XR4(i)=S4(i).xd; XR3(i)=S3(i).xd; XR2(i)=S2(i).xd; XR1(i)=S1(i).xd; S1(i).yd=rand(1,1)*ym; S2(i).yd=S1(i).yd; S3(i).yd=S1(i).yd; S4(i).yd=S3(i).yd; YR4(i)=S4(i).yd; S4(i).G=0; YR3(i)=S3(i).yd; S3(i).G=0; YR2(i)=S2(i).yd; YR1(i)=S1(i).yd; S1(i).G=0; S2(i).G=0; S1(i).E=Eo*(1+rand*a); S2(i).E=S1(i).E; S3(i).E=S1(i).E; S4(i).E=S3(i).E; E3(i)= S3(i).E; E4(i)= S4(i).E; Et=Et+E3(i); %initially there are no cluster heads only nodes S1(i).type='N'; S2(i).type='N'; S3(i).type='N'; S4(i).type='N'; end S1(n+1).xd=sink.x; S1(n+1).yd=sink.y; S2(n+1).xd=sink.x; S2(n+1).yd=sink.y; %3.网络运行模块 %簇头节点数 countCHs1=0; cluster1=1;%此定义的目的仅仅是给定一个1开始的下标参数，真正的簇头数应该还减去1 flag_first_dead1=0; flag_teenth_dead1=0; flag_all_dead1=0; %死亡节点数 dead1=0; first_dead1=0; teenth_dead1=0; all_dead1=0; %活动节点数 allive1=n; %counter for bit transmitted to Bases Station and to Cluster Heads packets_TO_BS1=0; packets_TO_CH1=0; %(1)循环模式设定 for r=0:1:rmax %该 for 循环将下面的所有程序包括在内，直到最后一 end 才结束循环 r %每过一个轮转周期(本程序为10次)使各节点的S（i）.G参数（该参数用于后面的簇选举，在该轮转周期内已当选过簇头的节点不能再当选）恢复为零 if(mod(r, round(1/p) )==0) for i=1:1:n S1(i).G=0; S1(i).cl=0; end end %(2)死亡节点检查模块 dead1=0; for i=1:1:n %检查有无死亡节点 if (S1(i).E<=0) dead1=dead1+1; %(3)第一个死亡节点的产生时间(用轮次表示) %第一个节点死亡时间 if (dead1==1) if(flag_first_dead1==0) first_dead1=r; flag_first_dead1=1; end end %10%的节点死亡时间 if(dead1==0.1*n) if(flag_teenth_dead1==0) teenth_dead1=r; flag_teenth_dead1=1; end end if(dead1==n) if(flag_all_dead1==0) all_dead1=r; flag_all_dead1=1; end end end if S1(i).E>0 S1(i).type='N'; end end STATISTICS.DEAD1(r+1)=dead1; STATISTICS.ALLIVE1(r+1)=allive1-dead1; %(4)簇头选举模块 countCHs1=0; cluster1=1; for i=1:1:n if(S1(i).E>0) temp_rand=rand; if ( (S1(i).G)<=0) %簇头的选举，当选的簇头会把各种相关信存入下面程序所给定的变量中 if(temp_rand<= (p/(1-p*mod(r,round(1/p))))) countCHs1=countCHs1+1; packets_TO_BS1=packets_TO_BS1+1; PACKETS_TO_BS1(r+1)=packets_TO_BS1; S1(i).type='C'; S1(i).G=round(1/p)-1; C1(cluster1).xd=S1(i).xd; C1(cluster1).yd=S1(i).yd; distance=sqrt( (S1(i).xd-(S1(n+1).xd) )^2 + (S1(i).yd-(S1(n+1).yd) )^2 ); C1(cluster1).distance=distance; C1(cluster1).id=i; X1(cluster1)=S1(i).xd; Y1(cluster1)=S1(i).yd; cluster1=cluster1+1; %计算簇头发送4000bit数据到基站的能量消耗（这里应是所有节点包括簇头每一轮发送4000bit数据） distance; if (distance>do) S1(i).E=S1(i).E- ( (ETX+EDA)*(4000) + Emp*4000*( distance*distance*distance*distance )); end if (distance<=do) S1(i).E=S1(i).E- ( (ETX+EDA)*(4000) + Efs*4000*( distance * distance )); end end end % S(i).G=S(i).G-1; end end STATISTICS.COUNTCHS1(r+1)=countCHs1; %(5)簇内成员选择簇头模块(即簇的形成模块) %簇内成员对簇头的选择（即簇的形成）算法 for c=1:1:cluster1-1 x1(c)=0; end y1=0; z1=0; for i=1:1:n if ( S1(i).type=='N' && S1(i).E>0 ) if(cluster1-1>=1) min_dis=Inf; min_dis_cluster=0; for c=1:1:cluster1-1 temp=min(min_dis,sqrt( (S1(i).xd-C1(c).xd)^2 + (S1(i).yd-C1(c).yd)^2 ) ); if ( temp<min_dis ) min_dis=temp; min_dis_cluster=c; x1(c)=x1(c)+1; end end %簇内节点（发送4000bit数据）能量消耗 min_dis; if (min_dis>do) S1(i).E=S1(i).E- ( ETX*(4000) + Emp*4000*( min_dis * min_dis * min_dis * min_dis)); end if (min_dis<=do) S1(i).E=S1(i).E- ( ETX*(4000) + Efs*4000*( min_dis * min_dis)); end %簇头（接受和融合这一簇内节点4000bit数据）的能量消耗 S1(C1(min_dis_cluster).id).E = S1(C1(min_dis_cluster).id).E- ( (ERX + EDA)*4000 ); packets_TO_CH1=packets_TO_CH1+1; S1(i).min_dis=min_dis; S1(i).min_dis_cluster=min_dis_cluster; else y1=y1+1; min_dis=sqrt( (S1(i).xd-S1(n+1).xd)^2 + (S1(i).yd-S1(n+1).yd)^2 ); if (min_dis>do) S1(i).E=S1(i).E- ( ETX*(4000) + Emp*4000*( min_dis * min_dis * min_dis * min_dis)); end if (min_dis<=do) S1(i).E=S1(i).E- ( ETX*(4000) + Efs*4000*( min_dis * min_dis)); end packets_TO_BS1=packets_TO_BS1+1; end end end if countCHs1~=0 u1=(n-y1)/countCHs1; for c=1:1:cluster1-1 z1=(x1(c)-u1)*(x1(c)-u1)+z1; end LBF1(r+1)=z1/countCHs1; else LBF1(r+1)=0; end STATISTICS.PACKETS_TO_CH1(r+1)=packets_TO_CH1; STATISTICS.PACKETS_TO_BS1(r+1)=packets_TO_BS1; end %3.网络运行模块 %簇头节点数 countCHs2=0; cluster=1;%此定义的目的仅仅是给定一个1开始的下标参数，真正的簇头数应该还减去1 flag_first_dead2=0; flag_teenth_dead2=0; flag_all_dead2=0; %死亡节点数 dead2=0; first_dead2=0; teenth_dead2=0; all_dead2=0; %活动节点数 allive2=n; %counter for bit transmitted to Bases Station and to Cluster Heads packets_TO_BS2=0; packets_TO_CH2=0; %(1)循环模式设定 for r=0:1:rmax %该 for 循环将下面的所有程序包括在内，直到最后一 end 才结束循环 r %每过一个轮转周期(本程序为10次)使各节点的S（i）.G参数（该参数用于后面的簇选举，在该轮转周期内已当选过簇头的节点不能再当选）恢复为零 if(mod(r, round(1/p) )==0) for i=1:1:n S2(i).G=0; S2(i).cl=0; end end %(2)死亡节点检查模块 dead2=0; for i=1:1:n %检查有无死亡节点 if (S2(i).E<=0) dead2=dead2+1; %(3)第一个死亡节点的产生时间(用轮次表示) %第一个节点死亡时间 if (dead2==1) if(flag_first_dead2==0) first_dead2=r; flag_first_dead2=1; end end %10%的节点死亡时间 if(dead2==0.1*n) if(flag_teenth_dead2==0) teenth_dead2=r; flag_teenth_dead2=1; end end if(dead2==n) if(flag_all_dead2==0) all_dead2=r; flag_all_dead2=1; end end end if S2(i).E>0 S2(i).type='N'; end end STATISTICS.DEAD2(r+1)=dead2; STATISTICS.ALLIVE2(r+1)=allive2-dead2; %(4)簇头选举模块 countCHs2=0; cluster2=1; for i=1:1:n if(S2(i).E>0) temp_rand=rand; if ( (S2(i).G)<=0) %簇头的选举，当选的簇头会把各种相关信存入下面程序所给定的变量中 if(temp_rand<= (p/