clc;clear all;close all;
%% 定位场景设置
s0(:,1)=[10e2;0];%观测站1的位置
s0(:,2)=[-10e2;0];%观测站2的位置
s0(:,3)=[0e2;8e2];%观测站3的位置
s0(:,4)=[15e2;0];%观测站4的位置
arfa=1/3*pi;
d=130e2;%目标到原点距离
p=d*[cos(arfa);sin(arfa);0];%目标位置
M=size(s0,2);
%% 相关参数设置
c=3e8; %光速
model=2;%1:DPD,2:TDOA+FDOA两步法
c1=2;%学习因子
c2=2;%学习因子
Dimension=2;%粒子维度,和目标的维度一致
Size=20;%粒子群大小
Tmax=100;%最大迭代次数
Fun_Ub=[5e3;5e3];%位置上界,默认对应下界为-Fun_Ub
Xmax(1:Dimension)=p+Fun_Ub.*[1;1];%粒子位置上下界,即函数自变量的上下界
Xmin(1:Dimension)=p-Fun_Ub.*[1;1];
Velocity_max=Xmax-Xmin;%粒子最大速度,由目标位置的可行解范围(目标位置的上下界)决定
Vmax(1:Dimension)=Velocity_max;%粒子速度上下界
Vmin(1:Dimension)=-Velocity_max;
%% PSO粒子群初始化
[Position,Velocity]=Initial_position_velocity(Dimension,Size,Xmax,Xmin,Vmax,Vmin);%初始化粒子位置和速度<