一种消防人员室内定位算法的制作方法

文档序号:11947142阅读:来源:国知局

技术特征:

1.一种消防人员室内定位方法,其特征在于,包括以下步骤:

S01:携带包含ZigBee模块的定位器的人员通过定位器发送消息至定位基站;

S02:定位基站对接收到的消息通过ZigBee模块传送到集中器,集中器将所有定位基站传送过来的消息通过Wifi模块传送的上位机;

S03:上位机程序对接收到的基站定位消息进行处理,对新消息中包含的定位器进行遍历定位;

S04:上位机程序判断当前遍历到的定位器ID是否已在已存在的定位器列表中,若不在,加入定位器列表;

S05:根据当前遍历到的定位器的最近的位置以及时间,计算出当前此定位器可能出现的区域坐标集合,并扫描此坐标集合进行判断;

S06:定位器当前区域点坐标为A1(x1,y1),接收到消息的定位基站坐标为A2(x2,y2),判断A1、A2的距离是否小于等于消息中的信号距离,若小于则此A1点权值加一;

S07:选择权值最高的有效区域点为当前定位器所在位置,并存储定位器当前坐标点;重复执行步骤S03直至所有定位器都计算完毕。

2.根据权利要求1所述的消防人员室内定位方法,其特征在于,所述步骤S06中A1、A2的距离的计算公式为r^2=(x1-x2)^2+(y1-y2)^2,其中r为A1、A2距离。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1