专利名称：一种基于超声波的目标定位和追踪系统的制作方法
技术领域：
本发明涉及一种定位和追踪系统，尤其涉及一种基于超声波的目标定位和追踪系统。
背景技术：
在市场中已经有多种利用不同原理的物体定位系统，这些系统有些使用2. 4GHz 电磁波信号，有些使用红外信号，有些使用125KHZ电磁波信号。这些系统各有自己的优点和缺点。使用2. 4GHz电磁波信号的定位系统具有作用距离远的优点。但是由于2. 4GHz电磁波在空气中以光速传播导致以定时方式测距的方法在数十米量级的测距范围上出现很大的误差，即使使用了诸如卡尔曼滤波以及扩展卡尔曼滤波等先进信号处理方式后也很难使测距精度达到米级别，同时使用这些技术会使得系统结构复杂和成本上升，不利用大规模使用。使用RSSI方式的2. 4GHz电磁波定位系统通过计算电磁波到达目标时的能量，并根据发射时能量和信道衰减特性计算距离。该种方式的缺点是，在使用的每个场合都需要测定实际的信道衰减特性，并且当使用环境改变后，信道衰减特性将发生变化，导致系统在使用环境中需要不断的调整，如Microsoft开发的RADAR系统。该种的方式好处是，可以直接利用已经架设好的Wi-Fi信号接入点，不用重新架设设备。使用红外信号进行定位的系统，由于红外线具有很好的方向性，导致该种系统仅能对某一确定方向上的物体进行定位。并且由于红外线的穿透能力很差，在红外发射和被测物体之间有物体阻隔的时候系统将失效。使用125KHZ电磁波信号的定位系统，严格意义上无法称之为定位和追踪系统，其实际是一个单点定位系统。该系统布置在某些特定点，当有物体经过该点时系统将触发。该系统不能对空间中的任意点进行位置确定，也无法描述出物体的运动轨迹。CN101(^9931A中公开了一种超声波定位装置和定位方法，该装置含有超声波发射器和超声波接收器，被定位物体上含有超声波发射器。数个超声波接收器接收超声波信号从而对被定位物体进行定位。该方法具有几个缺点。1、该方法不能同时对多个待定位物体进行定位，由于被定位物体采用主动发送超声波的方式，导致如果多个被定位物体同时发送超声波信号会导致信道冲突，因此会降低系统单位时间内的定位容量。2、该定位装置在单个定位系统下无法覆盖较大范围，当需要覆盖较大范围时需要多个定位系统拼接使用从而造成成本的上升。3、该系统采用待测物体发射超声波的方式，导致待测物体能量消耗的加剧，超声波是物理波，产生发射满足定位条件的超声波信号对能量的要求很高，需要经常更换电池，因此该系统不适于长期便携式定位系统。
发明内容
本发明提供了一种基于超声波的目标定位和追踪系统，解决了传统定位系统覆盖范围�。荒芏缘ヒ荒勘杲卸ㄎ灰约安皇室顺な奔涫褂玫奈侍�。一种基于超声波的目标定位和追踪系统，包括服务器、发射端和固定在目标上的接收端，所述的发射端包括第一处理器，同时发出计时信号和超声波发射信号；将超声波传播速率和计时数据输入服务器；第一无线收发模块，将计时信号无线发射；接收计时数据传输给第一处理器；带至少3个不共线发射点的超声波发射模块，接收超声波发射信号，每个发射点依次间隔相同时间发射超声波信号；所述的接收端包括第二无线收发�？椋尴呓邮占剖毙藕攀淙氲诙砥鳎唤剖笔菸尴叻⑸洌怀ń邮漳？椋邮粘ㄐ藕牛坏诙砥鳎灰越邮斩耸盏郊剖毙藕盼鹗际笨蹋锹济扛龀ㄐ藕诺酱锬勘甑氖笨蹋玫郊剖笔荩洗环衿饕谰莩ùニ俾屎图剖笔荩玫礁鞣⑸涞阌肽勘曛涞木嗬耄扑隳勘甑奈恢�。所述的目标定位和追踪系统还包括连接第一处理器的温度传感器、湿度传感器和大气压传感器，对超声波的实际传播速率进行补偿修正。所述的超声波发射�？橛墒Ｗ黄�、译码器、功率放大电路以及超声波发射器组成。超声波发射器的位置为超声波信号的发射点，每个超声波发射器的输入端连接一路功率放大电路。所述的超声波接收模块由超声波接收器、缓冲放大器、多重反馈无增益带通滤波器以及多重反馈增益带通滤波器组成。本发明还提供了一种基于超声波的目标定位和追踪方法，包括(1)在至少三个不共线的固定发射点依次间隔相同时间发射超声波信号，目标接收所有超声波信号，测量所有超声波信号从各自固定发射点传播到目标的时间，根据测量结果，联同超声波传播速率计算目标到所有固定发射点的距离，求解得到目标的位置，(2)重复步骤(1)。优选的，相邻两个超声波信号的间隔时间大于超声波信号从固定发射点传播到目标的时间。本发明可以将接收端做成标签形式固定在目标上，体积小巧，便于携带。且能量消耗很�。诓桓坏绯刈纯鱿履芄槐Ｖこな奔涔ぷ�。本发明系统使用无线信号作为数据交换的媒介，提高了系统的抗干扰性能。本发明系统能够快速的部署应用，不需要多余的设备，利用现有的计算机即可完成整套系统的正常使用。对目标的材质没有任何要求，克服了如2. 4GHz信号定位系统应用于多金属物体环境出现的各种问题并且通过系统扩展的方法能够使得系统满足更大范围的定位需求。
图1为本发明目标定位和追踪系统的结构示意图；图2为本发明系统超声波发射�？榈慕峁故疽馔迹煌�3为本发明系统超声波接收�？榈慕峁故疽馔迹煌�4为本发明系统第一处理器的�？榻峁故疽馔迹煌�5为本发明系统发射点位置示意图；图6为单发射端小区域目标定位过程示意图；图7为图6所示定位过程目标和发射点空间位置示意图；图8为单发射端小区域目标追踪示意图。图9为多发射端大区域目标定位示意图；图10为多发射端大区域目标追踪示意图。
具体实施例方式如图1所示，一种基于超声波的目标定位和追踪系统，包括服务器发射端1、接收端2和服务器3，发射端1由第一无线收发�？�12、第一处理器11和超声波发射�？�13组成，接收端2由第二处理器21、第二无线收发�？�22和超声波接收�？�23组成。超声波发射�？�13包括三个超声波发射器(喇叭)136、137、138，数模转换器 (AD5413)131，通路选择的2_4译码器132，功率放大器133、134、135。第一无线收发模块12包括分别专门用于发射无线信号和专门用于接收无线信号的无线2. 4GHz通信芯片(nRFMLOl+) 121、122，两块芯片各自使用不同的天线、不同的工作子频段进行工作，可以提高信道的使用率，降低收发之间的碰撞冲突。无线2. 4GHz通信芯片122工作在2. 41GHz频率，无线2. 4GHz通信芯片121的工作在2. 48GHz频率。如图4所示，第一处理器11采用TI单片机MSP430F5510，其中三个输入管脚连接温度传感器111、湿度传感器112和大气压传感器113，三个输出管脚连接数模转换器 AM413，两个管脚连接2-4译码器132，两个SPI接口分别连接两个无线2. 4GHz通信芯片。 第一处理器11通过RS485电平转换芯片114连接服务器3。超声波接收�？�23由超声波接收器231、缓冲放大器232、多重反馈无增益电路 233以及多重反馈增益电路234组成。第二处理器21采用TI单片机MSP430F2221，连接多重反馈增益电路234的输出端。第二无线收发�？椴捎�2. 4GHz通信芯片，具备接收2. 4GHz电磁波和发射2. 4GHz 电磁波的能力，两种状态使用各自独立的天线。当接收�？榇τ诮邮兆刺保酒�306工作在2. 41GHz频率。当接收模块处于发射状态时，芯片306工作在2. 48GHz频率。接收端2安装在目标上，定位和追踪时，第一处理器11控制超声波发射�？�13的每个发射超声波发射器间隔5ms依次发出超声波信号1. 5ms,同时控制第一无线收发�？� 12发出计时信号，第二无线收发�？�22接收计时信号输入第二处理器21，第二处理器21 控制超声波接收�？�22接收超声波信号并开始计时；第二处理器21将各超声波发射器发出的超声波信号的到达时刻经第二无线收发�？�22和第一无线收发模块12上传给第一处理器，联合超声波的传播速率以及相邻超声波信号发出的时间间隔，第一处理器计算各发射点到目标的空间距离，求解得到目标的空间位置。以图5为例，对上述过程进行详细描述
三个超声波发射器位于空间点，P0(x0, y0, ζ。)、P1U1, Y1, Z1)、P2 (X2，y2, )，携带接收端的目标位于空间点P (X，1，ζ)；记录P。(X。，y0, Z0)^! (X1, Y1, Z1), P2 (x2, y2, Z2)的坐标点值，该三点不处在同一直线上。由PtlP1P2构成一个定位参考平面。目标在定位区域中随意移动，其坐标点未知。如图6所示，开始定位追踪时，第一处理器11控制数模转换器13产生具有升余弦包络的20ΚΗζ正弦信号。起初第一处理器11处于计时状态，产生计时中断，选择2-4译码器132使得正弦信号通路到功率放大器133，从而驱动超声波发射器136产生20ΚΗζ超声波信号。中断 1. 5ms后处理器11始计时，计时长度为5ms，又产生计时中断，控制2_4译码器132使得正弦信号通路到功率放大器134，使超声波发射器137发射超声波信号，中断1. 5ms后处理器 11始计时，计时长度为5ms，再次产生计时中断，制2-4译码器132使得正弦信号通路到功率放大器135，超声波发射器138发射超声波信号。如图6所示，接收端2中的无线2. 4GHz通信芯片在接收到无线信号的同时开始打开第一处理器21的定时器，并分别在定时之后的、、、、、时刻超声波接收器231接收到超声波发射�？橹谐ǚ⑸淦鞣⑸涞某ㄐ藕牛怀ń邮掌�231接收到超声波信号， 经过缓冲放大电路232、多重反馈无增益电路233以及多重反馈增益电路234接到第二处理器21的比较器端口，比较器判别超声波信号的到来。接收端2通过无线2. 4GHz通信芯片将、、t^ t2数据上传，发射端1利用接收无线信号的无线2. 4GHz通信芯片122接收、、、、、；通信芯片将、、、、、数据通过SPI数据接口传递给第一处理器11，计算得到各超声波信号从各自发射点传播到目标的时间Δ、、 At1^ At2,且
权利要求
1.一种基于超声波的目标定位和追踪系统，其特征在于，包括服务器、发射端和固定在目标上的接收端，所述的发射端包括第一处理器，同时发出计时信号和超声波发射信号；将超声波传播速率和计时数据输入服务器；第一无线收发�？椋剖毙藕盼尴叻⑸洌唤邮占剖笔荽涓谝淮砥鳎淮辽�3个不共线发射点的超声波发射�？椋邮粘ǚ⑸湫藕牛扛龇⑸涞阋来渭涓粝嗤奔浞⑸涑ㄐ藕牛凰龅慕邮斩税ǖ诙尴呤辗⒛？椋尴呓邮占剖毙藕攀淙氲诙砥鳎唤剖笔菸尴叻⑸洌怀ń邮漳？椋邮粘ㄐ藕牛坏诙砥鳎灰越邮斩耸盏郊剖毙藕盼鹗际笨蹋锹济扛龀ㄐ藕诺酱锬勘甑氖笨蹋玫郊剖笔荩洗环衿饕谰莩ùニ俾屎图剖笔荩玫礁鞣⑸涞阌肽勘曛涞木嗬耄扑隳勘甑奈恢�。
2.根据权利要求1所述的目标定位和追踪系统，其特征在于，包括连接第一处理器的温度传感器、湿度传感器和大气压传感器。
3.根据权利要求1所述的目标定位和追踪系统，其特征在于，所述的超声波发射�？橛墒Ｗ黄�、译码器、功率放大电路以及超声波发射器组成，超声波发射器的位置为超声波信号的发射点，每个超声波发射器的输入端连接一路功率放大电路。
4.根据权利要求1所述的目标定位和追踪系统，其特征在于，所述的超声波接收模块由超声波接收器、缓冲放大器、多重反馈无增益带通滤波器以及多重反馈增益带通滤波器组成。
5.根据权利要求1所述的目标定位和追踪系统，其特征在于，所述的发射端数量为至少两个，所有发射端以菊花链方式串接。
6.一种基于超声波的目标定位和追踪方法，包括(1)在至少三个不共线的固定发射点依次间隔相同时间发射超声波信号，目标接收所有超声波信号，测量所有超声波信号从各自固定发射点传播到目标的时间，根据测量结果， 联同超声波传播速率计算目标到所有固定发射点的距离，求解得到目标的位置，(2)重复步骤(1)。
7.根据权利要求6所述的目标定位和追踪方法，其特征在于，相邻两个超声波信号的间隔时间大于超声波信号从固定发射点传播到目标的时间。
全文摘要
本发明公开了一种基于超声波的目标定位和追踪系统，包括服务器、发射端和固定在目标上的接收端，所述的发射端包括第一无线收发�？�、带至少3个不共线的发射点的超声波发射�？橐约暗谝淮砥鳎凰龅慕邮斩税ǖ诙尴呤辗⒛？�、超声波接收模块以及第二处理器；服务器通过接收上传的至少3个超声波信号的传播时间和传播速率，计算发射点到目标的距离，求解目标的控制位置。本发明可以将接收端做成标签形式固定在目标上，体积小巧，便于携带。且能量消耗很小，在不更换电池状况下能够保证长时间工作。本发明系统使用无线信号作为数据交换的媒介，提高了系统的抗干扰性能。
文档编号G01S5/30GK102253368SQ20111009665
公开日2011年11月23日 申请日期2011年4月18日 优先权日2011年4月18日
发明者付涛, 任阳, 吴正珏 申请人:杭州华韵天略电子科技有限公司
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
