自主式移动对象室内三维定位跟踪系统与方法

自主式移动对象室内三维定位跟踪系统与方法
【专利摘要】本发明涉及了一种自主式移动对象室内三维定位跟踪系统与方法。其系统由信息处理主机、总路由器、路由器、信息采集设备、自主式定位跟踪设备、参考坐标节点组组成；其方法的操作步骤是：参考坐标节点发送数据、室内定位及修正、信息采集设备采集数据并发送、信息处理主机显示。采用本发明，不仅能够在二维平面内实现人、动物、物体等移动对象的定位跟踪，更能够在三维空间内实现移动对象的定位。本发明其系统结构简单、成本低廉；其方法操作简便、性能优异，为实现基于位置的服务奠定了基础，其适用于各种布局的室内定位跟踪场所，比如机场、火车站、医院或商场等大型复杂场所。
【专利说明】自主式移动对象室内H维定位跟踪系统与方法

【技术领域】
[0001] 本发明涉及了一种自主式移动对象室内H维定位跟踪系统与方法，特别是一种具 有H维定位功能的自主式移动对象室内H维定位跟踪系统与方法。

【背景技术】
[0002] 随着移动通信技术的发展，人们对于位置信息的需求不断增长，基于位置的服务 LBS化ocation Based Services)也越来越受到人们关注。基于位置的服务就是基于地理 位置数据开展的服务，所W定位技术是其关键。
[0003] 目前定位系统依据定位环境可分为室外定位和室内定位两种，室外定位主要有 全球定位系统（GPS, Global F*ositioning System)和蜂窝无线定位（Cellular wireless location)。由于室内定位的出发点不同，GI^和蜂窝无线定位系统不再适用于室内。所W， 目前实现整个基于位置服务的关键是精确、实时的室内定位技术。
[0004] 现阶段研究得最多的室内定位技术是基于射频信号的定位技术和算法，它们都需 要移动通信基站、无线网络接入点、信号发射培或中继器等外部设施支持，而且所需测量的 信号强度指示RSSI (RSSLReceived Si即al Strength Indicator)值等对环境的依赖性 太强，如果室内环境发生变化，增加或者减少一个遮挡物，都会导致在室内的每一个点上的 RSSI特性发生变化，从而导致当前的数据库及定位算法不再适用。可见该些方法所受室内 环境的限制太大，只适用于相对简单和开阔的室内环境，适应性和灵活性较差。
[0005] 近年来，由于微电机系统（MEMS, Micro Electro Mechanical System)的发展，各 种传感器尺寸不断变小，成本降低，出现了各类微传感器。MEMS微传感器与传统传感器相比 具有体积小、重量轻、成本低、功耗低、测量范围大、可靠性好、易于集成到终端设备中等优 点，使得人们把室内定位技术的目光投向了具有自主特性的惯性导航系统（INS，Inertial 化vigation System),自主式导航运用在室内定位就不需要引入外界的信息便可完成室内 H维定位跟踪。降低了对环境的依赖性，定位精度不会因为环境的变化而出现大幅度的波 动，稳定性和灵活性好。为了提高精准度，配合参考坐标节点组进行位置修正，既能够不受 室内环境的限制，又能够获得较高的精度。
[0006] 本发明提出了一种自主式移动对象室内H维定位跟踪系统与方法，采用本发明， 不仅能够在二维平面内实现人、动物、物体等移动对象的定位跟踪，更能够在H维空间内实 现移动对象的定位。适用于各种布局的室内定位跟踪场所，比如机场、火车站、医院或商场 等大型复杂场所。


【发明内容】

[0007] 本发明的目的在于针对已有技术存在的弊端，提供一种自主式移动对象室内H维 定位跟踪系统与方法，其系统结构简单、成本低廉，其方法操作简便、性能优异。
[0008] 为达上述目的，本发明采用下述技术方案： 一种自主式移动对象室内H维定位跟踪系统，由信息处理主机、总路由器、路由器、信 息采集设备、自主式定位跟踪设备和参考坐标节点组组成，其特征在于：所述信息处理主机 与总路由器之间W有线的方式连接；总路由器与路由器之间W有线的方式连接；路由器与 信息采集设备之间W有线的方式连接；信息采集设备与自主式定位跟踪设备之间W无线的 方式连接；自主式定位跟踪设备与参考坐标节点组之间W无线的方式连接。
[0009] 上述的路由器共有/7台，根据系统的规模，/7的大小可变；信息采集设备一个房间 配备一台，根据房间的数量，a和的大小可变；自主式定位跟踪设备共有U台，根据使用人 员的数量，U的大小可变；参考坐标节点组共有K台，根据系统的规模，K的大小可变；其中 /7、3、K可^全部相等，或者部分相等，或者全部不相等。
[0010] 上述的参考坐标节点组有H种构成方式： 互:参考坐标节点组由两个构成直线的参考坐标节点组成；愛参考坐标节点组由H个构成 等边H角形的参考坐标节点组成；1?参考坐标节点组由四个构成正方形的参考坐标节点 组成；参考坐标节点组用W上H种构成方式任意摆放在房间内，其中的一组摆放在房间的 口口作为参考原点。
[0011] 上述的参考坐标节点的电路结构；一个微处理器1连接一个存储模块1、一个设备 号及坐标设置模块1、一个显示模块1、一个开关1和一个无线数据收发模块1，所述无线数 据收发模块1连接一根天线1，所述开关1也连接存储模块1、设备号及坐标设置模块1、显 示模块1、无线数据收发模块1 W及一个电池1 ;所述无线数据收发模块1包含有一个无线 局域网模块1 W及一个蓝牙模块1。
[0012] 上述的自主式定位跟踪设备的电路结构；一个微处理器2连接一个显示模块2、一 个微电机系统(MEMS)模块、一个开关2、一个设备号及坐标设置模块2、一个无线数据收发 模块2和一个存储模块2,所述无线数据收发模块2连接一根天线2,所述开关2也连接显 示模块2、微电机系统(MEMS)模块、设备号及坐标设置模块2、无线数据收发模块2、存储模 块2 W及一个电池2。
[0013] 上述的微电机系统（MEMS)模块包含有一个气压计、一个巧螺仪、一个地磁感应器 W及一个加速计；所述无线数据收发模块2包含有一个无线局域网模块2 W及一个蓝牙模 块2。
[0014] 一种自主式移动对象室内H维定位跟踪方法，其特征在于操作步骤如下；1)参考 坐标节点发送数据，2)室内定位及修正，3)信息采集设备采集数据并发送，4)信息处理主机 、1以 /Jn O
[0015] 上述的步骤1)、步骤3)中，各种工作流程运行中，在参考坐标节点至自主式定位 跟踪设备的发送数据峽为参考坐标节点至自主式定位跟踪设备数据峽；在自主式定位跟踪 设备和信息采集设备之间的收发数据峽包括自主式定位跟踪设备至信息采集设备数据峽 和信息采集设备至自主式定位跟踪设备数据峽；在信息采集设备和信息处理主机之间的收 发数据峽包括信息采集设备至信息处理主机数据峽和信息处理主机至信息采集设备数据 中贞。
[0016] 上述的步骤1)中，参考坐标节点至自主式定位跟踪设备数据峽由同步码1、参考 坐标节点设备号、J坐标1、_7坐标1、Z坐标1、纠错码1组成江坐标代表平面横坐标，_7坐 标代表平面纵坐标，Z坐标代表垂直平面坐标。
[0017] 上述的步骤3)中，自主式定位跟踪设备至信息采集设备数据峽由同步码2、自主 式定位跟踪设备号I、x坐标2、_f坐标2、Z坐标2、纠错码2、校验I组成。
[0018] 上述的步骤3)中，信息采集设备至自主式定位跟踪设备数据峽由同步码3、信息 采集设备号1、确认信息1、纠错码3组成。
[0019] 上述的步骤3)中，信息采集设备至信息处理主机数据峽由同步码4、信息采集设 备号2、自主式定位跟踪设备号2、x坐标3、_f坐标3、z坐标3、纠错码4、校验2组成。
[0020] 上述的步骤3)中，信息处理主机至信息采集设备数据峽由同步码5、确认信息2、 纠错码5组成。
[0021] 上述的步骤1)参考坐标节点发送数据：设备号及坐标设置模块1设置参考坐标 节点的参考坐标节点设备号W及坐标，显示模块1显示参考坐标节点的参考坐标节点设备 号和当前坐标，参考坐标节点根据跟踪移动对象的需要设置广播频率，参考坐标节点有两 种广播方式:至无线局域网模块1不断向外发送参考坐标节点至自主式定位跟踪设备数据 峽；雪蓝牙模块1不断向外发送参考坐标节点至自主式定位跟踪设备数据峽。
[0022] 上述的步骤2)室内定位及修正：设备号及坐标设置模块2设置自主式定位跟踪 设备的自主式定位跟踪设备号1，自主式定位跟踪设备的起始点坐标有两种确定方式：玉 设备号及坐标设置模块2设置自主式定位跟踪设备的起始点坐标；寒自主式定位跟踪设备 从参考坐标节点接收参考坐标节点至自主式定位跟踪设备数据峽，自主式定位跟踪设备根 据接收到的参考坐标节点的信号强度值计算起始点坐标；显示模块2显示自主式定位跟踪 设备的自主式定位跟踪设备号1和起始点坐标，微电机系统(MEMS)模块中气压计采集气压 数据、巧螺仪采集角速度数据、地磁感应器采集磁场强度数据、加速计采集加速度数据，自 主式定位跟踪设备根据微电机系统（MEMS)模块中采集到的数据将数据处理成H维坐标，自 主式定位跟踪设备将前一时刻的坐标和当前时刻计算的坐标进行对比，如果两点距离相差 大于阀值则丢弃当前时刻的坐标，自主式定位跟踪设备从参考坐标节点接收参考坐标节点 至自主式定位跟踪设备数据峽，自主式定位跟踪设备根据接收到的参考坐标节点的信号强 度值判断是否进入参考坐标节点组内部；如果自主式定位跟踪设备进入参考坐标节点组内 部，自主式定位跟踪设备根据获得的参考坐标节点的信号强度值在参考坐标节点组内部进 行定位，自主式定位跟踪设备把坐标修正到定位得到的坐标；如果自主式定位跟踪设备没 有进入参考坐标节点组内部，自主式定位跟踪设备不进行坐标修正；自主式定位跟踪设备 由无线局域网模块2发送自主式定位跟踪设备至信息采集设备数据峽给信息采集设备，自 主式定位跟踪设备在规定时间内接收信息采集设备发回的信息采集设备至自主式定位跟 踪设备数据峽，如果自主式定位跟踪设备在规定时间内没有接收到信息采集设备发回的信 息采集设备至自主式定位跟踪设备数据峽，显示模块2显示自主式定位跟踪设备的自主式 定位跟踪设备号1 W及通信失败，如果自主式定位跟踪设备在规定时间内接收了到信息采 集设备发回的信息采集设备至自主式定位跟踪设备数据峽，自主式定位跟踪设备根据信息 采集设备至自主式定位跟踪设备数据峽中的确认信息1来判断自主式定位跟踪设备发送 给信息采集设备的数据是否被信息采集设备所正确接收，如果自主式定位跟踪设备发送给 信息采集设备的数据被信息采集设备错误接收，显示模块2显示自主式定位跟踪设备的自 主式定位跟踪设备号1 W及信息错误接收，如果自主式定位跟踪设备发送给信息采集设备 的数据被信息采集设备正确接收，显示模块2显示自主式定位跟踪设备的自主式定位跟踪 设备号1、当前坐标、移动对象的运动轨迹W及通信成功，自主式定位跟踪设备继续接收数 据。
[0023] 上述的步骤3)信息采集设备采集数据并发送；信息采集设备接收自主式定位跟 踪设备发来的数据峽，信息采集设备判断是否收到了自主式定位跟踪设备发来的自主式定 位跟踪设备至信息采集设备数据峽：如果收到了自主式定位跟踪设备发来的自主式定位 跟踪设备至信息采集设备数据峽，信息采集设备发送信息采集设备至自主式定位跟踪设备 数据峽给自主式定位跟踪设备，如果没有收到自主式定位跟踪设备发来的自主式定位跟踪 设备至信息采集设备数据峽，信息采集设备继续接收自主式定位跟踪设备发来的数据峽； 信息采集设备经路由器和总路由器发送信息采集设备至信息处理主机数据峽给信息处理 主机，信息采集设备在规定时间内接收信息处理主机经路由器和总路由器发回的信息处理 主机至信息采集设备数据峽，如果信息采集设备在规定时间内没有接收到信息处理主机发 回的信息处理主机至信息采集设备数据峽，信息采集设备显示通信失败，如果信息采集设 备在规定时间内接收了到信息处理主机发回的信息处理主机至信息采集设备数据峽，信息 采集设备根据信息处理主机至信息采集设备数据峽中的确认信息2来判断信息采集设备 发送给信息处理主机的数据是否被信息处理主机所正确接收，如果信息采集设备发送给信 息处理主机的数据被信息处理主机错误接收，信息采集设备显示信息错误接收，如果信息 采集设备发送给信息处理主机的数据被信息处理主机正确接收，信息采集设备显示通信成 功，信息采集设备继续接收数据；任意一台信息采集设备可W采集在特定区域内任意数量 的自主式定位跟踪设备的数据，步骤信息采集设备采集数据并发送描述的是其中一台信息 采集设备采集任意一台自主式定位跟踪设备的数据并发送给信息处理主机的过程。
[0024] 上述的步骤4)信息处理主机显示：自主式定位跟踪设备发送自主式定位跟踪设 备至信息采集设备数据峽给信息采集设备，信息采集设备经路由器和总路由器发送信息采 集设备至信息处理主机数据峽给信息处理主机，信息处理主机存储数据并将各台自主式定 位跟踪设备的自主式定位跟踪设备号1、当前H维坐标W及移动对象的轨迹在用户交互界 面上显示出来。
[0025] 本发明与现有技术相比较，具有如下显而易见的突出实质性特点和显著优点：本 发明的系统由信息处理主机、总路由器、路由器、信息采集设备、自主式定位跟踪设备、参考 坐标节点组组成；其方法的操作步骤是：参考坐标节点发送数据、室内定位及修正、信息采 集设备采集数据并发送、信息处理主机显示。采用本发明，不仅能够在二维平面内实现人、 动物、物体等移动对象的定位跟踪，更能够在H维空间内实现移动对象的定位。本发明其系 统结构简单、成本低廉；其方法操作简便、性能优异，为实现基于位置的服务奠定了基础，其 适用于各种布局的室内定位跟踪场所，比如机场、火车站、医院或商场等大型复杂场所。

【专利附图】

【附图说明】
[0026] 图1是本发明一个实施例的系统结构框图。
[0027] 图2是图1示例的实现自主式移动对象室内H维定位跟踪的参考坐标节点组内部 结构图。
[0028] 图3是图1示例的实现自主式移动对象室内H维定位跟踪的参考坐标节点设备结 构框图。
[0029] 图4是图I示例的实现自主式移动对象室内H维定位跟踪的自主式定位跟踪设备 结构框图。
[0030] 图5是图1示例的实现自主式移动对象室内H维定位跟踪方法操作程序框图。
[0031] 图6是图1示例的实现参考坐标节点至自主式定位跟踪设备数据峽结构框图。
[0032] 图7是图1示例的实现自主式定位跟踪设备至信息采集设备数据峽结构框图。
[0033] 图8是图1示例的实现信息采集设备至自主式定位跟踪设备数据峽结构框图。
[0034] 图9是图1示例的实现信息采集设备至信息处理主机数据峽结构框图。
[00巧]图10是图1示例的实现信息处理主机至信息采集设备数据峽结构框图。
[0036] 图11是图5示例的实现室内定位及修正工作流程。
[0037] 图12是图5示例的实现信息采集设备采集数据并发送工作流程。
[0038] 图13本发明一个实施例的设备分布图。

【具体实施方式】
[0039] 本发明的优先实施例结合附图详述如下： 实施例一： 参见图1，本自主式移动对象室内H维定位跟踪系统由信息处理主机（1)、总路由器 (2)、路由器（3.1、…、3./7)、信息米集设备（4.1.1、4.1.2、…、4.1.<^，…，4./7.1、4./7.2、…、 4./7.W、自主式定位跟踪设备（5. 1、5. 2、…、5.U)和参考坐标节点组（6. 1、6. 2、6. 3、…、 6. K)组成，其特征在于：所述信息处理主机（1)与总路由器（2)之间W有线的方式连接；总 路由器（2)与路由器（3.1、…、3./7)之间W有线的方式连接；路由器（3.1、…、3./7)与信息 采集设备（4. 1. 1、4. 1. 2、…、4. 1.3,…，4./?. 2、…、4./?./0之间W有线的方式连接； 信息采集设备（4. 1.1、4. 1.2、…、4. 1.3，…，4./?. 2、…、4./?. W与自主式定位跟踪 设备（5. 1、5. 2、…、5. U)之间W无线的方式连接；自主式定位跟踪设备（5. 1、5. 2、…、5. U) 与参考坐标节点组（6. 1、6. 2、6. 3、…、6. F)之间W无线的方式连接。其中路由器（3. 1、…、 3. /?)共有/7台，根据系统的规模，/7的大小可变；信息采集设备（4. 1. 1、4. 1.2、…、4. 1.3,…， 4. /?. 2、…、4./?./0 -个房间配备一台，根据房间的数量，a和/7的大小可变；自主式 定位跟踪设备（5. 1、5. 2、…、5. U)共有U台，根据使用人员的数量，U的大小可变；参考坐 标节点组（6. 1、6. 2、6. 3、…、6. F)共有F台，根据系统的规模，F的大小可变；其中/7、3、/7、 ?、K可W全部相等，或者部分相等，或者全部不相等。
[0040] 参见图2,其中的参考坐标节点组（6. 1、6.2、6. 3、…、6. V)有H种构成方式；互参 考坐标节点组（6. 1、6. 2、6. 3、…、6. V)由两个构成直线的参考坐标节点（7. 1、7. 2)组成； 是参考坐标节点组（6. 1、6. 2、6. 3、…、6. V)由H个构成等边H角形的参考坐标节点（7. 3、 7. 4、7. 5)组成；覆参考坐标节点组（6. 1、6. 2、6. 3、…、6. V)由四个构成正方形的参考坐标 节点（7. 6、7. 7、7. 8、7. 9)组成；参考坐标节点组（6. 1、6. 2、6. 3、…、6. V)用W上H种构成 方式任意摆放在房间内，其中的一组摆放在房间的口口作为参考原点。
[0041] 参见图 3,其中的参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)的电 路结构：一个微处理器1 (8)连接一个存储模块1 (9)、一个设备号及坐标设置模块1 (10)、 一个显示模块1 (11)、一个开关1 (13)和一个无线数据收发模块1 (14)，所述无线数据收 发模块I (14)连接一根天线I (15)，所述开关I (13)也连接存储模块I (9)、设备号及 坐标设置模块1 (10)、显示模块1 (11)、无线数据收发模块1 (14) W及一个电池1 (12); 所述无线数据收发模块1 (14)包含有一个无线局域网模块1 (14. OW及一个蓝牙模块1 (14. 2)。
[0042] 参见图4,其中的自主式定位跟踪设备（5. 1、5. 2、…、5.U)的电路结构；一个微 处理器2 (16)连接一个显示模块2 (17)、一个微电机系统（MEMS)模块（18)、一个开关2 (20)、一个设备号及坐标设置模块2 (21)、一个无线数据收发模块2 (22)和一个存储模块 2 (23)，所述无线数据收发模块2 (22)连接一根天线2 (24)，所述开关2 (20)也连接显 示模块2 (17)、微电机系统（MEMS)模块（18)、设备号及坐标设置模块2 (21)、无线数据收 发模块2 (22)、存储模块2 (23) W及一个电池2 (19)。其中的微电机系统(MEMS)模块 (18)包含有一个气压计（18. 1)、一个巧螺仪（18. 2)、一个地磁感应器（18. 3) W及一个加速 计（18. 4);所述无线数据收发模块2 (22)包含有一个无线局域网模块2 (22. OW及一个 蓝牙模块2 (22. 2)。
[0043] 参见图5,本自主式移动对象室内H维定位跟踪方法采用上述系统进行定位跟踪， 其特征在于包括操作步骤如下；1)参考坐标节点发送数据（25)，2)室内定位及修正（26)， 3)信息采集设备采集数据并发送（27)，4)信息处理主机显示（28)。其中的步骤1)参考坐 标节点发送数据（25);设备号及坐标设置模块1 (10)设置参考坐标节点（7. 1、7. 2、7. 3、 7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)的参考坐标节点设备号（31) W及坐标，显示模块1 (11)显示 参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)的参考坐标节点设备号（31)和 当前坐标，参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)根据跟踪移动对象的 需要设置广播频率，参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)有两种广播 方式；至无线局域网模块1 (14. 1)不断向外发送参考坐标节点至自主式定位跟踪设备数 据峽（29);受蓝牙模块1 (14. 2)不断向外发送参考坐标节点至自主式定位跟踪设备数据 峽（29)。其中的步骤4)信息处理主机显示（28);自主式定位跟踪设备（5. 1、5. 2、…、5. U) 发送自主式定位跟踪设备至信息采集设备数据峽（36)给信息采集设备（4. 1. 1、4. 1. 2、…、 4. La, ...,4. n. 1、4. n. 2、...，4. n. b),信息米集设备（4. 1. 1、4. 1.2、...，4. La, ...,4. n. 1、 4. n. 2、…、4. n.b)经路由器（3. 1、…、3. n)和总路由器（2)发送信息采集设备至信息处理 主机数据峽（49)给信息处理主机（1)，信息处理主机（1)存储数据并将各台自主式定位跟 踪设备（5. 1、5. 2、…、5. U)的自主式定位跟踪设备号1 (38)、当前H维坐标W及移动对象 的轨迹在用户交互界面上显示出来。
[0044] 参见图6,图7,图8,图9,图10,其各种工作流程运行中，在参考坐标节点（7. 1、 7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)至自主式定位跟踪设备（5. 1、5. 2、…、5.")的发送 数据峽为参考坐标节点至自主式定位跟踪设备数据峽（29);在自主式定位跟踪设备（5. 1、 5. 2、...，5.")和信息米集设备（4. 1. 1、4. 1.2、...，4. La, ...,4./7. 2、...，4./7./0 之 间的收发数据峽包括自主式定位跟踪设备至信息采集设备数据峽（36)和信息采集设备至 自主式定位跟踪设备数据峽（44);在信息采集设备（4. 1. 1、4. 1.2、…、4. 1.3，…，4./?. 1、 4./7. 2、…、4./7./0和信息处理主机（1)之间的收发数据峽包括信息采集设备至信息处理主 机数据峽（49 )和信息处理主机至信息采集设备数据峽（58 )。
[0045] 参见图6,参考坐标节点至自主式定位跟踪设备数据峽（29)由同步码1(30)、参考 坐标节点设备号（31)、X坐标I (32)、_f坐标I (33)、Z坐标I (34)、纠错码I (35)组成； X坐标代表平面横坐标，坐标代表平面纵坐标，Z坐标代表垂直平面坐标。
[0046] 参见图7,自主式定位跟踪设备至信息采集设备数据峽（36)由同步码2(37)、自主 式定位跟踪设备号1 (38)、X坐标2 (39)、坐标2 (40)、Z坐标2 (41)、纠错码2 (42)、 校验1 (43)组成。
[0047] 参见图8,信息采集设备至自主式定位跟踪设备数据峽（44)由同步码3 (45)、信 息采集设备号1 (46)、确认信息1 (47)、纠错码3 (48)组成。
[0048] 参见图9,信息采集设备至信息处理主机数据峽（49)由同步码4(50)、信息采集设 备号2 (51)、自主式定位跟踪设备号2 (52)、x坐标3 (53)、_f坐标3 (54)、z坐标3 (55)、 纠错码4 (56)、校验2 (57)组成。
[0049] 参见图10,信息处理主机至信息采集设备数据峽（58)由同步码5 (59)、确认信息 2 (60)、纠错码5 (61)组成。
[0050] 参见图11，步骤2)室内定位及修正（26);设备号及坐标设置模块2 (21)设置自 主式定位跟踪设备（5. 1、5. 2、…、5. U)的自主式定位跟踪设备号1 (38)，自主式定位跟踪 设备（5. 1、5. 2、…、5. U)的起始点坐标有两种确定方式；'玄设各号及坐标设置模块2 (21) 设置自主式定位跟踪设备（5. 1、5. 2、…、5. U)的起始点坐标；是自主式定位跟踪设备（5. 1、 5. 2、…、5. U)从参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)接收参考坐标节 点至自主式定位跟踪设备数据峽（29)，自主式定位跟踪设备（5. 1、5. 2、…、5.U)根据接收 到的参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)的信号强度值计算起始点坐 标；显示模块2 (17)显示自主式定位跟踪设备（5. 1、5. 2、…、5.U)的自主式定位跟踪设备 号1 (38)和起始点坐标，微电机系统(MEMS)模块（18)中气压计（18. 1)采集气压数据、巧 螺仪（18. 2 )采集角速度数据、地磁感应器（18. 3 )采集磁场强度数据、加速计（18. 4 )采集加 速度数据，自主式定位跟踪设备（5. 1、5. 2、…、5. U)根据微电机系统（MEMS)模块（18)中采 集到的数据将数据处理成H维坐标，自主式定位跟踪设备（5. 1、5. 2、…、5. U)将前一时刻 的坐标和当前时刻计算的坐标进行对比，如果两点距离相差大于阀值则丢弃当前时刻的坐 标，自主式定位跟踪设备（5. 1、5. 2、…、5.U)从参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、 7. 7、7. 8、7. 9)接收参考坐标节点至自主式定位跟踪设备数据峽（29)，自主式定位跟踪设备 (5. 1、5. 2、…、5. U)根据接收到的参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9) 的信号强度值判断是否进入参考坐标节点组（6. 1、6. 2、6. 3、…、6. V)内部；如果自主式定 位跟踪设备（5. 1、5. 2、…、5. U)进入参考坐标节点组（6. 1、6. 2、6. 3、…、6. V)内部，自主式 定位跟踪设备（5. 1、5. 2、…、5. U)根据获得的参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、 7. 7、7. 8、7. 9)的信号强度值在参考坐标节点组（6. 1、6. 2、6. 3、…、6. V)内部进行定位，自 主式定位跟踪设备（5. 1、5. 2、…、5. U)把坐标修正到定位得到的坐标；如果自主式定位跟 踪设备（5. 1、5. 2、…、5. U)没有进入参考坐标节点组（6. 1、6. 2、6. 3、…、6. V)内部，自主 式定位跟踪设备（5. 1、5. 2、…、5. U)不进行坐标修正；自主式定位跟踪设备（5. 1、5. 2、…、 5. U)由无线局域网模块2 (22. 1)发送自主式定位跟踪设备至信息采集设备数据峽（36)给 信息采集设备（4. 1. 1、4. 1.2、…、4. La,…，4.n. l、4.n. 2、…、4.n.b)，自主式定位跟踪 设备（5. 1、5. 2、…、5. U)在规定时间内接收信息采集设备（4. 1.1、4. 1.2、…、4. La,…， 4. n. 1、4. n. 2、…、4. n. b)发回的信息采集设备至自主式定位跟踪设备数据峽（44)，如果 自主式定位跟踪设备（5. 1、5. 2、…、5. u)在规定时间内没有接收到信息采集设备（4. I. 1、 4. 1.2、…、4. La, .",4. n.l、4.n. 2、…、4. n.b)发回的信息米集设备至自主式定位跟踪设 备数据峽（44)，显示模块2 (17)显示自主式定位跟踪设备（5. 1、5. 2、…、5. U)的自主式定 位跟踪设备号1 (38)W及通信失败，如果自主式定位跟踪设备（5. 1、5. 2、…、5. U)在规定时 间内接收了到信息采集设备（4.1. 1、4. 1.2、…、4. La, -",4.11. l、4.n. 2、…、4. n.b)发回 的信息采集设备至自主式定位跟踪设备数据峽（44)，自主式定位跟踪设备（5. 1、5. 2、…、 5. U)根据信息采集设备至自主式定位跟踪设备数据峽（44)中的确认信息1 (47)来判断自 主式定位跟踪设备（5. 1、5. 2、…、5. U)发送给信息采集设备（4. 1. 1、4. 1.2、…、4. La,…， 4. n. 1、4. n. 2、...，4. n. b)的数据是否被信息采集设备（4. 1. 1、4. 1. 2、...，4. 1. a, ...,4. n. 1、 4. n. 2、…、4. n.b)所正确接收，如果自主式定位跟踪设备（5. 1、5. 2、…、5. U)发送给信息 采集设备（4. 1. 1、4. 1.2、…、4. La, -",4. n. 1、4. n. 2、…、4. n. b)的数据被信息采集设备 (4. 1. 1、4. 1.2、...，4. La, ...,4. n. 1、4. n. 2、...，4. n. b)错误接收，显示模块 2 (17)显示 自主式定位跟踪设备（5. 1、5. 2、…、5. U)的自主式定位跟踪设备号1 (38) W及信息错误接 收，如果自主式定位跟踪设备（5. 1、5. 2、…、5. U)发送给信息米集设备（4. 1. 1、4. 1. 2、…、 4. 1. a,…，4. n. 1、4. n. 2、...，4. n. b)的数据被信息采集设备（4. 1. 1、4. 1. 2、...，4. 1. a,…， 4. n.l、4.n. 2、…、4. n.b)正确接收，显示模块2 (17)显示自主式定位跟踪设备（5.1、 5.2、…、5. U)的自主式定位跟踪设备号1 (38)、当前坐标、移动对象的运动轨迹W及通信 成功，自主式定位跟踪设备（5. 1、5. 2、…、5. U)继续接收数据。
[0051] 参见图12,步骤3)信息采集设备采集数据并发送（27);信息采集设备（4. 1. 1、 4. 1.2、…、4. 1.3，…，4./?. 2、…、4./?. W接收自主式定位跟踪设备（5. 1、5. 2、…、 5. U)发来的数据峽，信息采集设备（4. 1. 1、4. 1. 2、…、4. 1.3，…,4./7. 1、4./7. 2、…、4./7./0 判断是否收到了自主式定位跟踪设备（5. 1、5. 2、…、5.U)发来的自主式定位跟踪设备至信 息采集设备数据峽（36);如果收到了自主式定位跟踪设备（5. 1、5. 2、…、5. U)发来的自主 式定位跟踪设备至信息采集设备数据巾贞（36)，信息采集设备（4. 1. 1、4. 1. 2、…、4. La,…， 4./7. 1、4./7. 2、…、4.化W发送信息采集设备至自主式定位跟踪设备数据峽（44)给自主式定 位跟踪设备（5. 1、5. 2、…、5.U)，如果没有收到自主式定位跟踪设备（5. 1、5. 2、…、5.U)发 来的自主式定位跟踪设备至信息采集设备数据峽（36)，信息采集设备（4. 1. 1、4. 1. 2、…、 4. 1.3,…，4./?. 1、4./?.2、…、4./7./0继续接收自主式定位跟踪设备（5. 1、5. 2、…、5.")发 来的数据峽；信息采集设备（4. 1. 1、4. 1.2、…、4. 1.3，...，4./7. 2、...，4./7./0 经路 由器（3. 1、…、3.n)和总路由器（2)发送信息采集设备至信息处理主机数据峽（49)给信息 处理主机（1)，信息米集设备（4. 1. 1、4. 1.2、…、4. 1.3，...，4./7. 2、…、4./7./0 在规 定时间内接收信息处理主机（1)经路由器（3. 1、…、3. n)和总路由器（2)发回的信息处理 主机至信息采集设备数据峽（58)，如果信息采集设备（4. 1. 1、4. 1. 2、…、4. 1.3,…，4./?. 1、 4./7. 2、…、4./7. W在规定时间内没有接收到信息处理主机（1)发回的信息处理主机至信 息米集设备数据巾贞（58)，信息米集设备（4.1. 1、4. 1.2、…、4.1.<3，...，4./7. 1、4./7.2、…、 4./7./0显不通信失败，如果信息米集设备（4.1.1、4.1.2、…、4.1.<^，…，4./7.1、4./7.2、…、 4./7./0在规定时间内接收了到信息处理主机（1)发回的信息处理主机至信息采集设备数据 中贞（58)，信息米集设备（4. 1. 1、4. 1.2、…、4. 1.3，...，4./7. 1、4./?.2、…、4./7./0 根据信息 处理主机至信息采集设备数据峽（58)中的确认信息2 (60)来判断信息采集设备（4. 1. 1、 4. 1.2、…、4. l.a, ...,4./7. 1、4./7. 2、...，4./7./0发送给信息处理主机（I)的数据是否被 信息处理主机（1)所正确接收，如果信息采集设备（4. 1. 1、4. 1.2、…、4. 1.3，…，4./?. 1、 4./7. 2、…、4./7./0发送给信息处理主机（1)的数据被信息处理主机（1)错误接收，信息采 集设备（4. 1. 1、4. 1.2、…、4. 1.3，...，4./7. 2、...，4./7./0 显示信息错误接收，如果 信息采集设备（4. 1. 1、4. 1.2、…、4. 1.3，…，4./?. 2、…、4./7.W发送给信息处理主 机（1)的数据被信息处理主机（1)正确接收，信息采集设备（4. 1. 1、4. 1.2、…、4. 1.3,…， 4./?. 1、4./7. 2、…、4./7. W显示通信成功，信息采集设备（4. 1. 1、4. 1. 2、…、4. 1.3,…，4./7. 1、 4./?.2、...,4./7./0继续接收数据；任意一台信息采集设备（4. 1. 1、4. 1.2、…、4. 1.3，…， 4. /?. l、4.n. 2、…、4.化/〇可W采集在特定区域内任意数量的自主式定位跟踪设备（5. 1、 5. 2、…、5. U)的数据，步骤3)信息采集设备采集数据并发送（27)描述的是其中一台信息 采集设备（4. 1. 1、4. 1. 2、…、4. 1.3，...，4./7. 2、...，4./7./0 采集任意一台自主式定 位跟踪设备（5. 1、5. 2、…、5. U)的数据并发送给信息处理主机（1)的过程。
[0052] 实施例二： 参见图13,本自主式移动对象室内H维定位跟踪系统由信息处理主机（1)、总路由器 (2)、路由器（3. 1、…、3. n)、信息米集设备（4. 1. 1、4. 1. 2、…、4. 1. a, ...,4. n. 1、4. n. 2、…、 4.n.b)、自主式定位跟踪设备（5.1、5.2、…、5.u)、参考坐标节点组（6.1、6.2、6.3、…、6.v) 组成。由图13可W看出，参考坐标节点组（6. 1、6.2、6. 3、…、6. V)任意摆放在房间内，其中 的一组摆放在房间的口口作为参考原点，参考坐标节点组（6. 1、6. 2、6. 3、…、6. V)不断向 外广播数据峽。移动对象佩戴自主式定位跟踪设备（5. 1、5.2、…、5.U)可W在整栋楼里面 随意走动，自主式定位跟踪设备（5. 1、5. 2、…、5. U)会根据自身采集到的数据画出运动轨 迹，当自主式定位跟踪设备（5. 1、5. 2、…、5.U)运动到参考坐标节点组（6. 1、6. 2、6. 3、…、 6. V)内部时，自主式定位跟踪设备（5. 1、5. 2、…、5. U)会在参考坐标节点组内部进行定位并 修正位置。每个信息采集设备（4. 1. 1、4. 1.2、…、4. La,…，4.n. l、4.n. 2、…、4.n.b)管 理一个特定区域，任意一个信息米集设备（4. 1. 1、4. 1. 2、…、4. 1. a,…，4. n. 1、4. n. 2、…、 4. n.b)的管理区域互不干扰，一般情况下一个房间一个信息采集设备（4. 1. 1、4. 1. 2、…、 4. La,…，4.n. l、4.n. 2、…、4.n.b)。一个路由器（3. 1、…、3.n)管理特定数量的信息采 集设备（4. 1. 1、4. 1. 2、...，4. 1. a,…，4. n. 1、4. n. 2、…、4. n. b), -般情况下一层楼一个路 由器。总路由器（2)管理整幢楼里所有的路由器（3.1、…、3. n)。信息采集设备（4. 1.1、 4. 1.2、...，4. La, ...,4. n. 1、4. n. 2、...，4. n. b)将采集到的信息经路由器（3. 1、…、3. n) 和总路由器（2)发送给信息处理主机（1)。信息处理主机（1)存储数据并将各台自主式定 位跟踪设备（5. 1、5. 2、…、5.U)的自主式定位跟踪设备号1 (38)、当前H维坐标W及移动 对象的轨迹在用户交互界面上显示出来。
【权利要求】
1. 一种自主式移动对象室内三维定位跟踪系统，由信息处理主机（I)、总路由器（2)、 路由器（3.1、一、3./7)、信息米集设备（4.1.1、4.1.2、一、4.1.<3，...，4./?.1、4./7.2、...、
4. /7./0、自主式定位跟踪设备（5. 1、5. 2、"·、5.?)和参考坐标节点组（6. 1、6. 2、6. 3、…、 6.O组成，其特征在于：所述信息处理主机（1)与总路由器（2)之间以有线的方式连接；总 路由器（2)与路由器（3.1、…、3./?)之间以有线的方式连接；路由器（3.1、…、3./?)与信 息米集设备（4.1.1、4.1.2、...、4.1.<3，...，4./7.1、4./7.2、...、4./?.办）之间以有线的方式连 接；信息米集设备（4· 1·1、4·L2、…、4.La,…，屯/?·^·/?·〗、…、4./7./0与自主式定位 跟踪设备（5. 1、5. 2、"·、5.?/)之间以无线的方式连接；自主式定位跟踪设备（5. 1、5. 2、…、 5.W)与参考坐标节点组（6. 1、6. 2、6. 3、"·、6.O之间以无线的方式连接。
2. 根据权利要求1所述的自主式移动对象室内三维定位跟踪系统,其特征在于：所述 路由器（3. 1、…、3./0共有/7台，根据系统的规模，/7的大小可变；信息采集设备（4. 1. 1、 4.L2、...、4.La, ...，4·/?· 1、4·/?· 2、...、4·/?·A) -个房间配备一台，根据房间的数量，a和 办的大小可变；自主式定位跟踪设备（5. 1、5. 2、…、5. ?)共有《台，根据使用人员的数量，《 的大小可变；参考坐标节点组（6. 1、6. 2、6. 3、"·、6.O共有r台，根据系统的规模，r的大 小可变；其中/?、<3、仏"、r可以全部相等，或者部分相等，或者全部不相等。
3. 根据权利要求1所述的自主式移动对象室内三维定位跟踪系统，其 特征在于：所述参考坐标节点组（6. 1、6. 2、6. 3、…、6.O有三种构成方式： $参考坐标节点组（6. 1、6. 2、6. 3、，··、6.O由两个构成直线的参考坐标节点（7. 1、7. 2) 组成；:?参考坐标节点组（6. 1、6. 2、6. 3、"·、6.r)由三个构成等边三角形的参考坐标节点 (7. 3、7. 4、7. 5)组成；③参考坐标节点组（6. 1、6. 2、6. 3、"·、6.幻由四个构成正方形的参 考坐标节点（7. 6、7. 7、7. 8、7. 9)组成；参考坐标节点组（6. 1、6. 2、6. 3、...、6.O用以上三 种构成方式任意摆放在房间内，其中的一组摆放在房间的门口作为参考原点。
4. 根据权利要求1所述的自主式移动对象室内三维定位跟踪系统,其特征在于：所述 参考坐标节点（7· 1、7· 2、7· 3、7· 4、7· 5、7· 6、7· 7、7· 8、7· 9)的电路结构：一个微处理器1 (8) 连接一个存储模块1 (9)、一个设备号及坐标设置模块1 (10)、一个显不模块1 (11)、一个 开关1 (13)和一个无线数据收发模块1 (14)，所述无线数据收发模块1 (14)连接一根天 线1 (15)，所述开关1 (13)也连接存储模块1 (9)、设备号及坐标设置模块1 (10)、显示模 块1 (11)、无线数据收发模块1 (14)以及一个电池1 (12);所述无线数据收发模块1 (14) 包含有一个无线局域网模块1 (14. 1)以及一个蓝牙模块1 (14.2)。
5. 根据权利要求1所述的自主式移动对象室内三维定位跟踪系统,其特征在于：所述 自主式定位跟踪设备（5. 1、5. 2、"·、5.?)的电路结构：一个微处理器2 (16)连接一个显 不模块2 (17)-个微电机系统模块（18)、一个开关2 (20)、一个设备号及坐标设置模块2 (21)、一个无线数据收发模块2(22)和一个存储模块2(23)，所述无线数据收发模块2(22) 连接一根天线2 (24)，所述开关2 (20)也连接显示模块2 (17)、微电机系统模块（18)、设 备号及坐标设置模块2 (21)、无线数据收发模块2 (22)、存储模块2 (23)以及一个电池2 (19)。
6. 根据权利要求5所述的自主式移动对象室内三维定位跟踪系统，其特征在于：所 述微电机系统模块（18)包含有一个气压计（18. 1)、一个陀螺仪（18. 2)、一个地磁感应器 (18. 3)以及一个加速计（18. 4);所述无线数据收发模块2 (22)包含有一个无线局域网模 块2 (22. 1)以及一个蓝牙模块2 (22. 2)。
7. -种自主式移动对象室内三维定位跟踪方法,采用根据权利要求1所述的自主式移 动对象室内三维定位跟踪系统进行操作，其特征在于操作步骤如下：1)参考坐标节点发送 数据（25)，2)室内定位及修正（26)，3)信息采集设备采集数据并发送（27)，4)信息处理主 机显示（28)。
8. 根据权利要求7所述的自主式移动对象室内三维定位跟踪方法，其特征在于：所 述步骤1)参考坐标节点发送数据、步骤3)信息采集设备采集数据并发送中，各种工作流 程中，在参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)至自主式定位跟踪设备 (5. 1、5. 2、"·、5. ?)的发送数据帧为参考坐标节点至自主式定位跟踪设备数据帧（29);在 自主式定位跟踪设备（5. 1、5. 2、和信息采集设备（4.I. 1、4. 1.2、…、4.La,…， 4./?. 1、4./?. 2、…、屯/?.^之间的收发数据帧包括自主式定位跟踪设备至信息采集设备数 据帧（36)和信息采集设备至自主式定位跟踪设备数据帧（44);在信息采集设备（4. 1. 1、 4. 1. 2、…、4.La,…，4./?. 1、4./?. 2、...、4./?.办）和信息处理主机（1)之间的收发数据帧包括 信息采集设备至信息处理主机数据帧（49 )和信息处理主机至信息采集设备数据帧（58 )。
9. 根据权利要求8所述的自主式移动对象室内三维定位跟踪方法，其特征在于：所述 步骤1)、步骤3)中，参考坐标节点至自主式定位跟踪设备数据帧（29)由同步码1 (30)、参 考坐标节点设备号（31)、^坐标I(32)、_f坐标I(33)、z坐标1 (34)、纠错码1 (35)组成； 所述自主式定位跟踪设备至信息采集设备数据帧（36)由同步码2 (37)、自主式定位跟踪设 备号1(38)、尤坐标2(39)、_7坐标2(40)、^坐标2(41)、纠错码2(42)、校验1(43)组 成；所述信息采集设备至自主式定位跟踪设备数据帧（44)由同步码3 (45)、信息采集设备 号1 (46)、确认信息1 (47)、纠错码3 (48)组成；所述信息采集设备至信息处理主机数据 帧（49)由同步码4 (50)、信息采集设备号2 (51)、自主式定位跟踪设备号2 (52)、z坐标 3 (53)、_f坐标3 (54)、z坐标3 (55)、纠错码4 (56)、校验2 (57)组成；所述信息处理主 机至信息采集设备数据帧（58)由同步码5 (59)、确认信息2 (60)、纠错码5 (61)组成# 坐标代表平面横坐标，坐标代表平面纵坐标，z坐标代表垂直平面坐标。
10. 根据权利要求7所述的自主式移动对象室内三维定位跟踪方法，其特征在于所述 步骤1)参考坐标节点发送数据（25):设备号及坐标设置模块1 (10)设置参考坐标节点 (7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)的参考坐标节点设备号（31)以及坐标，显示模 块I(11)显示参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)的参考坐标节点设 备号（31)和当前坐标，参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)根据跟踪 移动对象的需要设置广播频率，参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9) 有两种广播方式无线局域网模块1 (14. 1)不断向外发送参考坐标节点至自主式定位 跟踪设备数据帧（29) ;:f:蓝牙模块1 (14. 2)不断向外发送参考坐标节点至自主式定位跟 踪设备数据帧（29)。
11. 根据权利要求7所述的自主式移动对象室内三维定位跟踪方法，其特征在于所述 步骤2)室内定位及修正（26):设备号及坐标设置模块2 (21)设置自主式定位跟踪设备 (5. 1、5. 2、"·、5.?/)的自主式定位跟踪设备号1 (38)，自主式定位跟踪设备（5. 1、5. 2、…、
5. ^的起始点坐标有两种确定方式：X设备号及坐标设置模块2 (21)设置自主式定位跟 踪设备（5. 1、5. 2、的起始点坐标；自主式定位跟踪设备（5. 1、5. 2、从 参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)接收参考坐标节点至自主式定位 跟踪设备数据帧（29)，自主式定位跟踪设备（5. 1、5. 2、"·、5.?)根据接收到的参考坐标节 点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)的信号强度值计算起始点坐标；显示模块2 (17)显示自主式定位跟踪设备（5. 1、5. 2、的自主式定位跟踪设备号1 (38)和起始 点坐标，微电机系统(MEMS)模块（18)中气压计（18. 1)采集气压数据、陀螺仪（18. 2)采集角 速度数据、地磁感应器（18. 3)采集磁场强度数据、加速计（18. 4)采集加速度数据，自主式 定位跟踪设备（5. 1、5. 2、根据微电机系统(MEMS)模块（18)中采集到的数据将数 据处理成三维坐标，自主式定位跟踪设备（5. 1、5. 2、将前一时刻的坐标和当前时刻 计算的坐标进行对比，如果两点距离相差大于阀值则丢弃当前时刻的坐标，自主式定位跟 踪设备（5. 1、5· 2、...、5·?)从参考坐标节点（7· 1、7· 2、7· 3、7· 4、7· 5、7· 6、7· 7、7· 8、7· 9)接 收参考坐标节点至自主式定位跟踪设备数据帧（29)，自主式定位跟踪设备（5. 1、5. 2、…、 5. ?)根据接收到的参考坐标节点（7. 1、7. 2、7. 3、7. 4、7. 5、7. 6、7. 7、7. 8、7. 9)的信号强度 值判断是否进入参考坐标节点组（6. 1、6. 2、6. 3、"·、6.O内部：如果自主式定位跟踪设备 (5. 1、5. 2、"·、5.?/)进入参考坐标节点组（6. 1、6. 2、6. 3、"·、6.O内部，自主式定位跟踪 设备（5. 1、5· 2、"·、5·?)根据获得的参考坐标节点（7· 1、7· 2、7· 3、7· 4、7· 5、7· 6、7· 7、7· 8、 7. 9)的信号强度值在参考坐标节点组（6. 1、6. 2、6. 3、"·、6.r)内部进行定位，自主式定位跟 踪设备（5. 1、5. 2、…、5.?)把坐标修正到定位得到的坐标；如果自主式定位跟踪设备（5. 1、 5. 2、"·、5.?/)没有进入参考坐标节点组（6. 1、6. 2、6. 3、"·、6.幻内部，自主式定位跟踪设 备（5. 1、5. 2、不进行坐标修正；自主式定位跟踪设备（5. 1、5. 2、由无线局 域网模块2 (22. 1)发送自主式定位跟踪设备至信息采集设备数据帧（36)给信息采集设备 (4.I. 1、4.I. 2、...、4.La, ...，4·/?· 1、4·/?· 2、...、4·/?· 6)，自主式定位跟踪设备（5. 1、5· 2、...、
5.")在规定时间内接收信息米集设备（4.1.1、4.1.2、?、4.1.<3,...，4./7.1、4./7.2、...、
4./7./0发回的信息采集设备至自主式定位跟踪设备数据帧（44)，如果自主式定位跟踪设备 (5. 1、5. 2、在规定时间内没有接收到信息采集设备（4.I. 1、4. 1. 2、"·、4.La,…，
4./7. 1、4./?.2、…、屯/?.幻发回的信息采集设备至自主式定位跟踪设备数据帧（44)，显示模 块2 (17)显示自主式定位跟踪设备（5. 1、5. 2、的自主式定位跟踪设备号1 (38) 以及通信失败，如果自主式定位跟踪设备（5. 1、5.2、"·、5.?)在规定时间内接收了到信息 采集设备（4.L1、4· 1.2、...、4.La,…，屯/?· 1、4·/?· 2、…、4./7./0发回的信息采集设备至 自主式定位跟踪设备数据帧（44)，自主式定位跟踪设备（5. 1、5. 2、"·、5.?)根据信息采集 设备至自主式定位跟踪设备数据帧（44)中的确认信息1 (47)来判断自主式定位跟踪设备 (5.1、5.2、...、5.")发送给信息米集设备（4.1.1、4.1.2、...、4.1.<3，...，4./?.1、4./?.2、...、
4./7./0的数据是否被信息米集设备（4.L1、4·L2、…、4.La,…，4·/?· 1、4·/?· 2、…、4·/?·办） 所正确接收，如果自主式定位跟踪设备（5. 1、5. 2、发送给信息采集设备（4. 1. 1、 4. 1.2、…、4.La,…，4·/?· 1、4./7.2、…、4·/?·办）的数据被信息米集设备（4.L1、4.L2、…、 4.La,…，4./?. 1、4./?. 2、…、4./?.办）错误接收，显示模块2 (17)显示自主式定位跟踪设备 (5. 1、5. 2、…、5.W)的自主式定位跟踪设备号1 (38)以及信息错误接收，如果自主式定位 跟踪设备（5.1、5.2、"*、5.")发送给信息米集设备（4.1.1、4.1.2、?、4.1.<3，."，4./7.1、
4·/?·2、...、4·/?·办）的数据被信息米集设备（4.L1、4· 1.2、...、4·La, ...，4·/?· 1、4./?.2、…、 4./7./0正确接收，显示模块2 (17)显示自主式定位跟踪设备（5. 1、5. 2、"·、5.?)的自主式 定位跟踪设备号1 (38)、当前坐标、移动对象的运动轨迹以及通信成功，自主式定位跟踪设 备（5. 1、5. 2、"·、5.?)继续接收数据。
12. 根据权利要求7所述的自主式移动对象室内三维定位跟踪方法，其特征在于所述 步骤3)信息采集设备采集数据并发送（27):信息采集设备（4.I. 1、4. 1.2、…、4.I.a，…，
4. /?. 1、4./?. 2、...、4./?.办）接收自主式定位跟踪设备（5. 1、5. 2、...、5.?)发来的数据帧，信息 米集设备（4.L1、4·L2、...、4.La, ...，4·/?· 1、4·/?· 2、...、4./?.办）判断是否收到了自主式定 位跟踪设备（5. 1、5.2、一、5.?)发来的自主式定位跟踪设备至信息采集设备数据帧（36):如 果收到了自主式定位跟踪设备（5. 1、5. 2、发来的自主式定位跟踪设备至信息采集 设备数据巾贞（36)，信息米集设备（4.I. 1、4.L2、…、4.La,…，4·/?· 1、4·/?· 2、...、4·/?·办）发 送信息采集设备至自主式定位跟踪设备数据帧（44)给自主式定位跟踪设备（5. 1、5. 2、…、
5. ?)，如果没有收到自主式定位跟踪设备（5. 1、5. 2、-·、5. ?)发来的自主式定位跟踪设备至 信息米集设备数据巾贞（36)，信息米集设备（4.L1、4·L2、…、4.La,…，屯/?· 1、4·/?· 2、…、
4./?./0继续接收自主式定位跟踪设备（5. 1、5. 2、"·、5.?)发来的数据帧；信息采集设备 (4. 1. 1、4· 1. 2、...、4.La, ...，4·/?· 1、4·/?· 2、...、4./?.办）经路由器（3. 1、...、3·η)和总路由 器（2)发送信息采集设备至信息处理主机数据帧（49)给信息处理主机（1)，信息采集设备 (4.L1、4·L2、...、4·La, ...，4·/?· 1、4·/?· 2、…、4./7./0在规定时间内接收信息处理主机（1) 经路由器（3. 1、"·、3.η)和总路由器（2)发回的信息处理主机至信息采集设备数据帧（58)， 如果信息米集设备（4. 1. 1、4·L2、...、4.La, ...，4·/?· 1、4·/?· 2、...、4./?.办）在规定时间内没 有接收到信息处理主机（1)发回的信息处理主机至信息采集设备数据帧（58)，信息采集设 备（4.L1、4.L2、...、4.La,…，4·/?· 1、4·/?· 2、...、4·/?·办)显不通信失败，如果信息米集设备 (4.I. 1、4.L2、…、4.La, ...，4·/?· 1、4·/?· 2、...、4./?.办）在规定时间内接收了到信息处理主 机（1)发回的信息处理主机至信息采集设备数据帧（58)，信息采集设备（4.I. 1、4. 1. 2、…、 4.La, .",4./7. 1、4./?. 2、…、屯/?./?)根据信息处理主机至信息采集设备数据帧（58)中的 确认信息2(60)来判断信息采集设备（4.1.1、4.1.2、％、4.1. <3，...，4./7.1、4./7.2、...、
4. /?. /0发送给信息处理主机（1)的数据是否被信息处理主机（1)所正确接收，如果信息采 集设备（4.1.1、4.1.2、一、4.1.<3，...，4./7.1、4./7.2、一、4./?.办）发送给信息处理主机（1) 的数据被信息处理主机（1)错误接收，信息采集设备（4.I. 1、4. 1.2、…、4.La, .",4./7. 1、 4·/?· 2、…、4./7.A)显不信息错误接收，如果信息米集设备（4.1. 1、4·L2、…、4.La,…，
4./?. 1、4./?. 2、…、4./7./0发送给信息处理主机（1)的数据被信息处理主机（1)正确接收， 信息米集设备（4.I. 1、4.L2、…、4.I.a，…，4./?· 1、4·/?· 2、...、4·/?·办）显不通信成功，信息 采集设备（4.1.1、4.1.2、?、4.1.<3，...，4./7.1、4./7.2、...、4./7.办）继续接收数据 ；任意一 台信息米集设备（4.L1、4· 1.2、...、4.La,…，屯/?· 1、4·/?· 2、…、4./7./0可以米集在特定 区域内任意数量的自主式定位跟踪设备（5. 1、5. 2、…、5.?)的数据，步骤信息采集设备采 集数据并发送（27)描述的是其中一台信息米集设备（4. 1.1、4. 1.2、…、4.La, --?,tfl.l、
4./7. 2、…、4./7. 6)采集任意一台自主式定位跟踪设备（5. 1、5. 2、…、5.?)的数据并发送给 信息处理主机（1)的过程。
13. 根据权利要求8所述的自主式移动对象室内三维定位跟踪方法，其特征在于所述 步骤4)信息处理主机显示（28):自主式定位跟踪设备（5. 1、5. 2、"·、5.?)发送自主式定 位跟踪设备至信息采集设备数据帧（36)给信息采集设备（4.I. 1、4. 1.2、…、4.La,…， 4./?.1、4./7.2、...、4./7.6)，信息米集设备（4.1.1、4.1.2、...、4.1.<3，...，4./7.1、4./7.2、...、
4. /7./0经路由器（3. 1、"·、3.η)和总路由器（2)发送信息采集设备至信息处理主机数据帧 (49)给信息处理主机（1 )，信息处理主机（1)存储数据并将各台自主式定位跟踪设备（5. 1、 5. 2、的自主式定位跟踪设备号1 (38)、当前三维坐标以及移动对象的轨迹在用户 交互界面上显示出来。
【文档编号】G01S5/02GK104237846SQ201410173333
【公开日】2014年12月24日 申请日期:2014年4月28日 优先权日:2014年4月28日
【发明者】张金艺, 张洪晖, 王伟, 李建宇, 蔡春艳, 陈兴秀, 晏理 申请人:上海大学