声源定位

(

一

)

声源定位数据处理

在

MATLAB

软件中，编辑一个

M

文件，编辑窗口内容为：

functionF=dingwei(x)

F=[sqrt((300-x(1))^2+(450-x(2))^2)-sqrt(x(1)^2+x(2)^2)-x(3)*(t1-t4);

sqrt(x(1)^2+(450-x(2))^2)-sqrt(x(1)^2+x(2)^2)-x(3)*(t2-t4);

sqrt((300-x(1))^2+x(2)^2)-sqrt(x(1)^2+x(2)^2)-x(3)*(t3-t4)];

%

在函数中

x(1)=x;x(2)=y;x(3)=v;

并且我们将速度

v

看作未知数处理

说明：

创建了

M

文件，需要先将测得的

t1

、

t2

、

t3

、

t4

代入。

以第一组数据为例，由于

t1

、

t2

、

t3

、

t4

均为实验时测得的数据，因此在命令窗口中求解

函数之前，要先将在实验时获得的数据

t1=61.9

、

t2=47.4

、

t3=24.0

、

t4=0

，并重新保存。

保存后的

M

文件内容为：

functionF=dingwei(x)

F=[sqrt((300-x(1))^2+(450-x(2))^2)-sqrt(x(1)^2+x(2)^2)-x(3)*61.9;

sqrt(x(1)^2+(450-x(2))^2)-sqrt(x(1)^2+x(2)^2)-x(3)*47.4;

sqrt((300-x(1))^2+x(2)^2)-sqrt(x(1)^2+x(2)^2)-x(3)*24.0];

%

在函数中

x(1)=x;x(2)=y;x(3)=v;

并且我们将速度

v

看作未知数处理

然后，在命令窗口输入

>>clear

>>x0=[99,149,3];

>>options=optimt('Display','off');

>>fsolve(@dingwei,x0,options)

命令窗口输出：

ans=

96.0876141.25723.2175

如果想要看到中间的计算过程，可以输入如下程序：

>>x0=[99,149,3];

>>options=optimt('Display','iter');

>>[x,Fval]=fsolve(@dingwei,x0,options)

命令窗口输出：

NormofFirst-orderTrust-region

IterationFunc-countf(x)stepoptimalityradius

1473.65016871

282.304510.9181

3121.202862.511.52.5

4160.005894346.252.796.25

5204.39428e-0090.1752750.0028915.6

6244.34196e-0200..59e-00915.6

Optimizationterminatedsuccessfully:

1

声源定位实验数据表

说明：表格中灰色背景部分为原始数据，白色背景部分为计算所得数据。

.

x=

96.0876141.25723.2175

Fval=

1.0e-009*

0.0031

0.0798

0.1925

重复处理第一组数据的过程，将八组数据处理完后，整理得到如下表格

1

：

X

的平均值为：

103.3025(mm)

Y

的平均值为：

147.1782(mm)

V

的平均值为：

3.0056(km/s)

GPS

模拟数据处理

求解用户

1

（即ＮＯ１）的位置如下：

在

MATLAB

软件中，编辑一个

M

文件，编辑窗口内容为：

%

对用户

1

的位置进行求解

functionF=gps1(x)

F=[(150-x(1))^2+(150-x(2))^2-x(3)^2*(124.8^2);%

第一组

(200-x(1))^2+(100-x(2))^2-x(3)^2*(147.7^2);%

第二组

(200-x(1))^2+(150-x(2))^2-x(3)^2*(130.4^2);%

第三组

(150-x(1))^2+(200-x(2))^2-x(3)^2*(109.3^2);%

第四组

(200-x(1))^2+(200-x(2))^2-x(3)^2*(118.6^2);%

第五组

(150-x(1))^2+(250-x(2))^2-x(3)^2*(93.3^2);%

第六组

(100-x(1))^2+(250-x(2))^2-x(3)^2*(85.1^2);%

第七组

(100-x(1))^2+(200-x(2))^2-x(3)^2*(101.9^2);%

第八组

(100-x(1))^2+(150-x(2))^2-x(3)^2*(118.8^2);%

第九组

(100-x(1))^2+(100-x(2))^2-x(3)^2*(133.0^2)]%

第十组

2

X(mm)Y(mm)

V(km/s

)

t1(us)t2(us)t3(us)t4(us)

计算值

x

计算值

y

计算

值

v

1001502.982

61.947.424.0096.0876141.25723.2175

62.047.324.0097.1864143.61723.1293

62.546.421.9097.6007154.59392.9172

60.444.921.90112.7124148.23122.8489

61.847.223.9097.0742143.16533.1536

60.943.823.80109.6143150.65172.9206

60.544.322.90110.1801148.09602.9953

61.245.122.80105.9720147.81332.8624

ＧＰＳ模拟数据处理表

%

在这里

x(1)

表示用户

1

的横坐标，

X(2)

表示用户

1

的纵坐标，

x(3)

表示传播速度。

%

将速度按作未知数处理。

在命令窗口输入以下程序：

>>x0=[0,450,3];

>>options=optimt('Display','off');

>>fsolve(@gps1,x0,options)

命令窗口输出的内容很长，在此不完全列出，其中最后两行为最终答案：

ans=

-2.7087476.53722.9074

表明实际计算所得的用户１的坐标为（

-2.7087

，

476.5372

）。

用同样的方法可以求得用户２和用户３的坐标，最后整理得到表格如下：

3

原始数据

卫星用户

X(mm)Y(mm)T1(us)T2(us)T3(us)

150150124.8124.781.1

200100147.7134.087.9

200150130.4116.092.5

150200109.3110.593.3

200200118.6101.2106.0

15025093.394.0108.4

10025085.1107.6100.1

100200101.9119.687.2

100150118.8132.669.4

100100133.0146.656.7

4

处理结果

用户（接收

机）

理论坐标

（

mm

）

计算坐标（

mm

）

速度

（

km/s

）X

坐标

Y

坐标

1(0,450)-2.7087476.53722.9074

2(300,450)321.4867470.88612.9318

3(0,0)-16.4663-10.43582.8448