[发明专利]一种灾后搜救终端定位方法及生命探测装置

权利要求书

1.一种灾后搜救终端定位方法，其特征在于，所述方法包括：

A、至少4台生命探测装置同时接收终端的登记接入信号；

B、根据所述终端的登记接入信号计算得到所述终端的位置坐标；

C、根据连续两次所述登记接入信号计算得到的所述位置坐标对本次计算的到的所述位置坐标进行预测和校正，得到校正位置坐标；

D、比较所述校正位置坐标与所述位置坐标，若其差值小于预先设定的值，则将所述校正位置坐标作为所述终端的定位结果；否则，返回步骤B。

2.如权利要求1所述的方法，其特征在于，所述步骤B，进一步包括：

根据所述登记接入信号到达时间t及信号强度p，4台生命探测装置分别与所述终端的距离为

d1=c×t1-(cv-1)×Pt-Pr115]]>

d2=c×t2-(cv-1)×Pt-Pr215]]>

d3=c×t3-(cv-1)×Pt-Pr315]]>

d4=c×t4-(cv-1)×Pt-Pr415]]>

其中，所述d为4台生命探测装置分别与所述终端的距离，c为光速，t为所述登记接入信号分别到达4台生命探测装置的时间，v为电磁波在介质中传播速度，Pt为所述终端发射功率，Pr为4台生命探测装置分别接收到的所述登记接入信号强度；

4台生命探测装置位置坐标分别为(Xi，Yi，Zi)，i＝1，2，3，4，所述终端位置坐标为(x，y，z)，Ri1为所述终端与生命探测装置i和生命探测装置1的距离差，则

Ri1=(Xi-x)2+(Yi-y)2+(Zi-z)2-(X1-x)2+(Y1-y)2+(Z1-z)2]]>

可以得到以下方程组

R12=d1-d2=c×(t1-t2)-(cv-1)×(Pr2-Pr115)]]>

R23=d2-d3=c×(t2-t3)-(cv-1)×(Pr3-Pr215)]]>

R34=d3-d4=c×(t3-t4)-(cv-1)×(Pr4-Pr315)]]>

求解上述方程组可以得到所述终端的位置坐标(x，y，z)。