CN107064878B - 一种基于高精度gps的声源定位方法及其实现系统 - Google Patents
一种基于高精度gps的声源定位方法及其实现系统 Download PDFInfo
- Publication number
- CN107064878B CN107064878B CN201710507959.8A CN201710507959A CN107064878B CN 107064878 B CN107064878 B CN 107064878B CN 201710507959 A CN201710507959 A CN 201710507959A CN 107064878 B CN107064878 B CN 107064878B
- Authority
- CN
- China
- Prior art keywords
- signal
- sound
- sound source
- microphone
- coordinate
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
- G01S5/22—Position of source determined by co-ordinating a plurality of position lines defined by path-difference measurements
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明涉及一种基于高精度GPS的声源定位方法及其实现系统,包括步骤如下:(1)将麦克风阵列设置在监控区域的任意位置,麦克风上设置有GPS定位模块,至少4个麦克风处于同时工作状态;(2)麦克风实时获取声音信号,GPS定位模块实时获取时间信号和定位信号;(3)将声音信号、时间信号和定位信号进行存储;(4)根据指令获取对应的数据,通过TDOA声音定位算法计算时延,求解声源位置,即声源的经纬度、高度;(5)将声源位置进行显示。本发明将高精度GPS定位模块与无源的声源定位方法结合起来,GPS定位模块来测得采集声音信号的麦克风的位置信息,使用于采集声音信号的麦克风阵列不再受限于固定的相对位置。
Description
技术领域
本发明涉及一种基于高精度GPS的声源定位方法及其实现系统,属于声源定位技术领域。
背景技术
声音是信息的载体。一方面,声音中包含具有实际内容的语音信息,另一方面,由于声波的传播特性,声音中也间接包含了声源和传播环境的相关信息。基于上述的两种特性,声音信息的获取在安全监控、区域探测、定位搜寻等领域具有不可替代的作用。
早先对于未知目标的探测定位多是通过无线电、超声、激光等主动式方式进行,具有高精度抗干扰的优点。但主动方式由于需要发射信号,也有功耗高、暴露自身位置等使用限制。而声源定位采用被动式原理,隐蔽性较强,且不受能见度的影响,白天晚上都可以进行工作。声源定位在近场探测应用中有较高的精度,既可以单独构成系统使用,也可以为其它监控定位系统提供辅助信息,因而得到了广泛的关注和应用。
现阶段声源定位的算法主要有信号到达角度测量算法(Angle of Arrival,AOA)、信号到达时间测量算法(Time of Arrival,TOA)、信号到达时间差测量算法(TimeDifference of Arrival,TDOA)、接收信号强度指示算法(Received Signal StrengthIndication,RSSI)。现阶段的算法对麦克风阵列位置的放置均有所要求,并且只能求解出声源和麦克风阵列的相对位置,给实际应用过程带来了诸多的不便。
卫星定位技术自1958年美国建立子午卫星系统以来,60年间获得了蓬勃的发展。GPS、GLONASS、Galileo及中国北斗的建立,使得卫星定位在现代社会中发挥着越来越大的作用。随着技术的不断革新,定位系统的精度也逐步提高,采用载波相位差分技术(CarrierPhase Measurement,又称Real Time Kinematic,RTK)的定位系统可以达到毫米级的定位精度。
中国专利文献CN106019232A公开了一种声源定位系统和方法,所述系统包括全向麦克风、指向麦克风和定位单元。全向麦克风用于采集第一声音信息。指向麦克风用于采集第二声音信息。定位单元用于根据第一声音信息和第二声音信息定位声源在预定的第一平面中的两处疑似位置,并根据第二声音信息的幅度信息在两处疑似位置中确定声源的位置。其中,全向麦克风和指向麦克风位于第一直线上,指向麦克风不指向第一直线所在的、垂直于第一平面的第二平面。该专利存在以下缺陷:1.采用两种不同类型的麦克风,采集声音信号的差异容易引入较大的误差;2.需要通过声音信号的幅度来进行声源位置预估和筛选,对采集声音的环境要求和放大器的精度要求较高。
中国专利文献CN104181506A公开了一种基于改进PHAT加权时延估计的声源定位方法,由麦克风阵列采集4路声音信号,通过A/D采样电路转化为数字信号,并通过改进的PHAT加权广义互相关函数法进行时延估计算法处理,获得时延估计值,再结合放置的麦克风阵列空间位置,利用迭代法解非线性方程组,从而得到声源的相对位置。该专利存在以下缺陷:1.声源定位要基于固定的麦克风阵列,需提前预知麦克风所在坐标位置;2.计算出的位置坐标为基于麦克风阵列建立坐标系下的坐标值,在某些需要地图显示的应用场景中十分不便。
发明内容
为了克服现有声源定位方案中麦克风阵列相对固定,只能计算声源基于自建坐标系下相对位置的不足,本发明提出了一种基于高精度GPS的声源定位方法;
本发明还提供了上述声源定位方法的实现系统。
发明概述
本发明借助于高精度GPS系统得到麦克风的位置坐标,通过TDOA声源定位算法,求解出声源的经纬度与高度。由于得出的是通用的经纬度坐标,可以直接用于地图显示,或与其他系统衔接。
本发明在采集声音信号的麦克风上配置了GPS,可以实时解算麦克风的位置坐标,麦克风阵列可以不再局限于静态位置,彼此之间也不需要有固定的相对位置。在声波传播的范围内,只要有任意四路声音信号被采集到即可计算出声源的三维位置坐标信息。
术语解释:
1、RTK(Real-time kinematic)载波相位差分技术,是实时处理两个测量站载波相位观测量的差分方法,将基准站采集的载波相位发给用户接收机,进行求差解算坐标。
2、大地坐标系,是大地测量中以参考椭球面为基准面的坐标系。地面点P的位置用大地经度L、大地纬度B和大地高度H表示。
3、ECEF坐标系,ECEF(Earth-Centered,Earth-Fixed)地球为中心,是一个笛卡尔坐标系,也称为“普通地表”系统,(0,0,0)点表示地球质心。
本发明的技术方案为:
一种基于高精度GPS的声源定位方法,包括步骤如下:
(1)在声源定位的监控区域随意放置麦克风组成麦克风阵列,麦克风阵列中的每个麦克风上安装有GPS定位模块,麦克风阵列中至少4个麦克风处于同时工作状态且采集到有效的声音信号;
(2)麦克风阵列中处于工作状态的麦克风实时获取声音信号,麦克风阵列中处于工作状态的麦克风上安装的GPS定位模块实时获取位置信号,捕获的位置信号为NMEA-0183格式,从位置信号中提取出时间信号与定位信号即可计算各个麦克风采集声音信号的时间和地点,将获取的声音信号、时间信号和定位信号转换为统一格式的数字信号;
(3)将步骤(2)获取的声音信号、时间信号和定位信号进行存储;
(4)根据指令获取步骤(3)中存储的对应的数据,通过TDOA声音定位算法计算时延,列出方程组求解声源位置,包括声源的经度、纬度和高度;
(5)将步骤(4)中计算的声源位置进行显示。
根据本发明所优选的,所述步骤(4)中,通过TDOA声音定位算法计算时延,即采用TDOA声音定位算法中的广义自相关函数法进行时延计算,包括步骤如下:
A、分别取出同一时间段内的4路声音信号,即:x1(n)、x2(n)、x3(n)、x4(n),n为数字信号中采样点的序号,将4路声音信号进行加窗预滤波处理,消除噪声,经傅立叶变换到频域,即:X1(k),X2(k),X3(k),X4(k),k为与n对应的数字信号中采样点的序号,n与k皆为整数;
B、第一路声音信号x1(n)作为基准信号,分别计算X1(k)与X2(k)、X1(k)与X3(k)、X1(k)与X4(k)的互功率谱,即G12(k)、G13(k)、G14(k),对互功率谱G12(k)、G13(k)、G14(k)进行PHAT加权操作,如式(Ⅰ)、(Ⅱ)、(Ⅲ)所示:
式(Ⅰ)、(Ⅱ)、(Ⅲ)中,为X1(k)的共轭,为式(Ⅰ)的PHAT加权函数;
C、将互功率谱G12(k)、G13(k)、G14(k)逆变换到频域,得到对应的广义互相关函数R12(n),R13(n),R14(n);
D、R12(n),R13(n),R14(n)分别取最大值时n所对应的时延即为3路声音信号x2(n)、x3(n)、x4(n)与基准信号x1(n)的时延估计t12、t13、t14;设R12(n)取最大值时的n值为n12,所取声音信号的点数为N,采样频率为Fs,若n12>N/2,则若n12≤N/2,则t13和t14与t12计算方法一致。
根据本发明所优选的,所述步骤(4)中,求解声源位置,包括步骤如下:
a、将GPS定位模块计算的对应的四个麦克风的定位信号,包括经度、纬度、高度,从大地坐标系坐标转换到ECEF直角坐标系下坐标中的笛卡尔坐标,转换公式如式(Ⅳ)所示:
式(Ⅳ)中,为ECEF直角坐标系下坐标值(xi,yi,zi),为大地坐标系坐标,为纬度,λi为经度,hi为高度,a为椭球长半径,e为椭球第一偏心率;
根据式(Ⅳ)获取对应的四个麦克风的转换后的ECEF坐标系中的笛卡尔坐标,即(x1,y1,=1)(x2,y2,=2)(x3,y3,=3)(x4,y4,=4);
b、根据广义自相关函数法计算出的时延t12、t13、t14与步骤a获取的四个麦克风的坐标(x1,y1,=1)(x2,y2,=2)(x3,y3,=3)(x4,y4,=4),列出非线性方程组,如式(Ⅴ)所示:
式(Ⅴ)中,(x,y,z)为声源坐标;v为声音在空气中传播的速度;
用牛顿迭代法求解声源坐标(x,y,z);
c、采用ECEF直角坐标系参数来计算声源的大地高度、大地纬度和大地经度,ECEF直角坐标系下根据在xy平面中测量的声源坐标与x轴之间的角度计算出声源的大地经度λ:当x≥0时,当x<0且y≥0时,当x<0且y<0时,(x,y,z)是指声源坐标;
采用由Bowring提出的一种流行且高度收敛的迭代方法Bowring演算法,求取声源的大地纬度,
式(Ⅵ)中,p、u均为迭代算法中所需变量,a为椭球长半径,b为椭球短半径;
迭代循环:
直到tanu收敛,求得大地纬度
求取大地高度h:当否则,上式中e′为椭球第二偏心率。
通过以上计算则可得出声源的在大地坐标系下的经纬度坐标
根据本发明优选的,所述GPS定位模块通过RTK技术实时获取时间信号和定位信号。
GPS定位模块采用RTK技术,定位的精度可以达到毫米级。GPS定位模块得到的时间和位置信息为数字信号,通过串口传输。GPS定位位置坐标作为计算声源的参考坐标,GPS定位模块的定位精度将直接影响声源位置的精度。根据计算,GPS定位模块厘米级的定位误差在200米的定位范围只会导致米级的声源定位偏移。此外,麦克风处于动态运动过程中时,GPS定位模块的定位精度和数据更新速度会影响声源定位的精度,所以本系统需采用经RTK技术的卫星定位系统,以得到更好的定位精度。
上述声源定位方法的实现系统,包括至少4个MIC与GPS定位模块、存储模块、算法计算和系统控制模块、显示模块,至少4个所述MIC与GPS定位模块分别连接所述存储模块,所述存储模块、所述算法计算和系统控制模块、所述显示模块依次连接。
根据本发明优选的,所述MIC与GPS定位模块包括麦克风及用于定位的GPS定位模块,麦克风实时获取声音信号,GPS定位模块实时获取时间信号和位置信号;所述存储模块用于存储获取的声音信号、时间信号和定位信号;所述算法计算和系统控制模块通过TDOA声音定位算法计算时延,列出方程组求解声源位置,包括声源的大地经度、大地纬度和大地高度;所述显示模块用于显示声源位置。
根据本发明优选的,所述算法处理和系统控制模块为STM32开发平台,所述显示模块为液晶显示屏,所述GPS定位模块为北斗星通UM332。
本发明的有益效果为:
1、本发明将高精度GPS定位模块与无源的声源定位方法结合起来,GPS定位模块来测得采集声音信号的麦克风的位置信息,使用于采集声音信号的麦克风阵列不再受限于固定的相对位置。
2、本发明将GPS定位模块获取的定位坐标作为声源定位的参考坐标,可以直接求得声源的经纬度坐标和高度。
3、本发明可以直接与其它需要定位数据的系统衔接。
4、本发明采用相同的麦克风器件采集声音,极大减少声音采集器带来的误差,并且采用运算量较小的TDOA算法计算时延得到声源位置,对声音信号的幅度大小不作要求。
5、本发明采用高精度卫星定位芯片对麦克风进行定位,得到麦克风采集声音时的高精度经纬度坐标,进而可以求得声源的经纬度坐标,可以直接用于地图显示。另外此方案中,麦克风位置不需要固定,因而可以应用于移动探测场景。
附图说明
图1为本发明基于高精度GPS的声源定位方法的实现系统的结构框图;
具体实施方式
下面结合说明书附图和实施例对本发明作进一步限定,但不限于此。
实施例1
一种基于高精度GPS的声源定位方法,包括步骤如下:
(1)在声源定位的监控区域随意放置麦克风组成麦克风阵列,麦克风阵列中的每个麦克风上安装有GPS定位模块,麦克风阵列中4个麦克风处于同时工作状态且采集到有效的声音信号;
(2)麦克风阵列中处于工作状态的麦克风实时获取声音信号,麦克风阵列中处于工作状态的麦克风上安装的GPS定位模块实时获取位置信号,捕获的位置信号为NMEA-0183格式,从位置信号中提取出时间信号与定位信号即可计算各个麦克风采集声音信号的时间和地点,将获取的声音信号、时间信号和定位信号转换为统一格式的数字信号;
(3)将步骤(2)获取的声音信号、时间信号和定位信号进行存储;
(4)根据指令获取步骤(3)中存储的对应的数据,通过TDOA声音定位算法计算时延,列出方程组求解声源位置,包括声源的经度、纬度和高度;
通过TDOA声音定位算法计算时延,包括步骤如下:
A、分别取出同一时间段内的4路声音信号,即:x1(n)、x2(n)、x3(n)、x4(n),n为数字信号中采样点的序号,将4路声音信号进行加窗预滤波处理,消除噪声,经傅立叶变换到频域,即:X1(k),X2(k),X3(k),X4(k),k为与n对应的数字信号中采样点的序号,n与k皆为整数;
B、第一路声音信号x1(n)作为基准信号,分别计算X1(k)与X2(k)、X1(k)与X3(k)、X1(k)与X4(k)的互功率谱,即G12(k)、G13(k)、G14(k),对互功率谱G12(k)、G13(k)、G14(k)进行PHAT加权操作,如式(Ⅰ)、(Ⅱ)、(Ⅲ)所示:
式(Ⅰ)、(Ⅱ)、(Ⅲ)中,为X1(k)的共轭,为式(Ⅰ)的PHAT加权函数;
C、将互功率谱G12(k)、G13(k)、G14(k)逆变换到频域,得到对应的广义互相关函数R12(n),R13(n),R14(n);
D、R12(n),R13(n),R14(n)分别取最大值时n所对应的时延即为3路声音信号x2(n)、x3(n)、x4(n)与基准信号x1(n)的时延估计t12、t13、t14;设R12(n)取最大值时的n值为n12,所取声音信号的点数为N,采样频率为Fs,若n12>N/2,则若n12≤N/2,则t13和t14与t12计算方法一致。
求解声源位置,包括步骤如下:
a、将GPS定位模块计算的对应的四个麦克风的定位信号,包括经度、纬度、高度,从大地坐标系坐标转换到ECEF直角坐标系下坐标中的笛卡尔坐标,转换公式如式(Ⅳ)所示:
式(Ⅳ)中,为ECEF直角坐标系下坐标值(xi,yi,zi),为大地坐标系坐标,为纬度,λi为经度,hi为高度,a为椭球长半径,e为椭球第一偏心率;
根据式(Ⅳ)获取对应的四个麦克风的转换后的ECEF坐标系中的笛卡尔坐标,即(x1,y1,=1)(x2,y2,=2)(x3,y3,=3)(x4,y4,=4);
b、根据广义自相关函数法计算出的时延t12、t13、t14与步骤a获取的四个麦克风的坐标(x1,y1,=1)(x2,y2,=2)(x3,y3,=3)(x4,y4,=4),列出非线性方程组,如式(Ⅴ)所示:
式(Ⅴ)中,(x,y,z)为声源坐标;v为声音在空气中传播的速度;
用牛顿迭代法求解声源坐标(x,y,z);
c、采用ECEF直角坐标系参数来计算声源的大地高度、大地纬度和大地经度,ECEF直角坐标系下根据在xy平面中测量的声源坐标与x轴之间的角度计算出声源的大地经度λ:当x≥0时,当x<0且y≥0时,当x<0且y<0时,(x,y,z)是指声源坐标;
采用由Bowring提出的一种流行且高度收敛的迭代方法Bowring演算法,求取声源的大地纬度,
式(Ⅵ)中,p、u均为迭代算法中所需变量,a为椭球长半径,b为椭球短半径;
迭代循环:
直到tanu收敛,求得大地纬度
求取大地高度h:当否则,上式中e′为椭球第二偏心率。
通过以上计算则可得出声源的在大地坐标系下的经纬度坐标
(5)将步骤(4)中计算的声源位置进行显示。
GPS定位模块通过RTK技术实时获取时间信号和定位信号。
GPS定位模块采用RTK技术,定位的精度可以达到毫米级。GPS定位模块得到的时间和位置信息为数字信号,通过串口传输。GPS定位位置坐标作为计算声源的参考坐标,GPS定位模块的定位精度将直接影响声源位置的精度。根据计算,GPS定位模块厘米级的定位误差在200米的定位范围只会导致米级的声源定位偏移。此外,麦克风处于动态运动过程中时,GPS定位模块的定位精度和数据更新速度会影响声源定位的精度,所以本系统需采用经RTK技术的卫星定位系统,以得到更好的定位精度。
实施例2
实施例1所述的声源定位方法的实现系统,如图1所示,包括4个MIC与GPS定位模块、存储模块、算法计算和系统控制模块、显示模块,4个MIC与GPS定位模块分别连接存储模块,所述存储模块、算法计算和系统控制模块、显示模块依次连接。
MIC与GPS定位模块包括麦克风及用于定位的GPS定位模块,麦克风实时获取声音信号,GPS定位模块实时获取时间信号和位置信号;存储模块用于存储获取的声音信号、时间信号和定位信号;算法计算和系统控制模块通过TDOA声音定位算法计算时延,列出方程组求解声源位置,包括声源的大地经度、大地纬度和大地高度;显示模块用于显示声源位置。
算法处理和系统控制模块为STM32开发平台,所述显示模块为液晶显示屏,所述GPS定位模块为北斗星通UM332。
对比例1
根据实施例1所述的一种基于高精度GPS的声源定位方法,其区别在于,在声源定位的监控区域构成相对固定的麦克风阵列,对单一声源进行定位,麦克风阵列包括四路MIC,采集声音的麦克风为模拟MEMS MIC,具体包括以下步骤:
(1)四路MIC采集四路声音信号,采用两级放大电路对模拟信号进行50倍放大,并直流垫高至1.28v,ADC进行40kHz频率的AD采样。卫星定位系统进行定位,通过串口将位置信息导出。
(2)将声音信号、位置信号和时间信号传输至存储模块。为了便于对声音信号的存储,每4MB为一个存储文件。
(3)采用STM32作为计算控制模块,将四路所需的声音信号片段取出,通过广义自相关函数法进行时延计算得出t12,t13,t14三个时延估计。
(4)将MIC的定位坐标信息取出,此时坐标为WGS-84大地坐标系下坐标,将此坐标系下的距离转换为ECEF地心坐标系下坐标。结合4个MIC坐标和三个时延估计,列出线性方程组。
(5)然后采用牛顿迭代法求解三元非线性方程组坐标。
(6)再将此坐标转回WGS-84坐标,在液晶显示屏下显示。
对比例2
根据实施例1所述的一种基于高精度GPS的声源定位方法,其区别在于,在声源定位的监控区域构成相对固定的麦克风阵列,对单一声源进行定位,麦克风阵列包括四路MIC,采集声音的麦克风为模拟MEMS MIC,具体包括以下步骤:
(1)四路MIC采集四路声音信号,数字MIC时钟设为1.024MHz,输出为PDM信号,经语音处理芯片FM34-395经采样装换成16位的PCM信号。卫星定位系统进行定位,通过串口将位置信息导出。
(2)将声音信号、位置信号和时间信号传输至存储模块。为了便于对声音信号的存储,每4MB为一个存储文件。
(3)采用STM32作为计算控制模块,将四路所需的声音信号片段取出,通过广义自相关函数法进行时延估计计算得出t12,t13,t14三个时延估计;
(4)将MIC的定位坐标信息取出,此时坐标为WGS-84将此坐标系下的距离转换为ECEF地心坐标系下坐标。结合4个MIC坐标和三个时延估计,列出线性方程组。
(5)然后采用牛顿迭代法求解三元非线性方程组坐标。
(6)再将此坐标转回大地坐标,在液晶显示屏下显示。
对比例3
根据对比例2所述的一种基于高精度GPS的声源定位方法,其区别在于,四路MIC的数字MIC时钟设为2.475MHz,并对目标声源进行定位。
对比例4:
根据对比例2所述的一种基于高精度GPS的声源定位系统,其区别在于,设定六路声音采集模块,任意四路进行组网,对目标声源的定位估计求取平均值。
根据实施例1、对比例1-4验证,声音采集模块采集声音时基于固定麦克风阵列还是随意放置声源定位的精度影响不大,极大保证了声源定位系统的灵活性。采用模拟MIC采集声音时,放大器、ADC引入的噪声偏大,定位精度不如采用数字MIC的声源定位系统。提高声音的采样频率,确实能在一定程度上提高声源定位的精度,但也相应增加了数据的存储量和运算量。
Claims (5)
1.一种基于高精度GPS的声源定位方法,其特征在于,包括步骤如下:
(1)在声源定位的监控区域随意放置麦克风组成麦克风阵列,麦克风阵列中的每个麦克风上安装有GPS定位模块,麦克风阵列中至少4个麦克风处于同时工作状态且采集到有效的声音信号;
(2)麦克风阵列中处于工作状态的麦克风实时获取声音信号,麦克风阵列中处于工作状态的麦克风上安装的GPS定位模块实时获取位置信号,捕获的位置信号为NMEA-0183格式,从位置信号中提取出时间信号与定位信号即可计算各个麦克风采集声音信号的时间和地点,将获取的声音信号、时间信号和定位信号转换为统一格式的数字信号;所述GPS定位模块通过RTK技术实时获取时间信号和定位信号;
(3)将步骤(2)获取的声音信号、时间信号和定位信号进行存储;
(4)根据指令获取步骤(3)中存储的对应的数据,通过TDOA声音定位算法计算时延,列出方程组求解声源位置,包括声源的经度、纬度和高度;包括步骤如下:
a、将GPS定位模块计算的对应的四个麦克风的定位信号,包括经度、纬度、高度,从大地坐标系坐标转换到ECEF直角坐标系下坐标中的笛卡尔坐标,转换公式如式(IV)所示:
式(IV)中,为ECEF直角坐标系下坐标值(xi,yi,zi),为大地坐标系坐标,为纬度,λi为经度,hi为高度,a为椭球长半径,e为椭球第一偏心率;
根据式(IV)获取对应的四个麦克风的转换后的ECEF坐标系中的笛卡尔坐标,即(x1,y1,z1)(x2,y2,z2)(x3,y3,z3)(x4,y4,z4);
b、根据广义自相关函数法计算出的时延t12、t13、t14与步骤a获取的四个麦克风的坐标(x1,y1,z1)(x2,y2,z2)(x3,y3,z3)(x4,y4,z4),列出非线性方程组,如式(V)所示:
式(V)中,(x,y,z)为声源坐标;v为声音在空气中传播的速度;
用牛顿迭代法求解声源坐标(x,y,z);
c、采用ECEF直角坐标系参数来计算声源的大地高度、大地纬度和大地经度,ECEF直角坐标系下根据在xy平面中测量的声源坐标与x轴之间的角度计算出声源的大地经度λ:当x≥0时,当x<0且y≥0时,当x<0且y<0时,(x,y,z)是指声源坐标;
采用Bowring演算法,求取声源的大地纬度,
式(VI)中,p、u均为迭代算法中所需变量,a为椭球长半径,b为椭球短半径;
迭代循环:
直到tan u收敛,求得大地纬度
求取大地高度h:当否则,
上式中e′为椭球第二偏心率;
通过以上计算则可得出声源的在大地坐标系下的经纬度坐标
(5)将步骤(4)中计算的声源位置进行显示。
2.根据权利要求1所述的一种基于高精度GPS的声源定位方法,其特征在于,所述步骤(4)中,通过TDOA声音定位算法计算时延,即采用TDOA声音定位算法中的广义自相关函数法进行时延计算,包括步骤如下:
A、分别取出同一时间段内的4路声音信号,即:x1(n)、x2(n)、x3(n)、x4(n),n为数字信号中采样点的序号,将4路声音信号进行加窗预滤波处理,消除噪声,经傅立叶变换到频域,即:X1(k),X2(k),X3(k),X4(k),k为与n对应的数字信号中采样点的序号,n与k皆为整数;
B、第一路声音信号x1(n)作为基准信号,分别计算X1(k)与X2(k)、X1(k)与X3(k)、X1(k)与X4(k)的互功率谱,即G12(k)、G13(k)、G14(k),对互功率谱G12(k)、G13(k)、G14(k)进行PHAT加权操作,如式(I)、(II)、(III)所示:
式(I)、(II)、(III)中,为X1(k)的共轭,为式(I)的PHAT加权函数;
C、将互功率谱G12(k)、G13(k)、G14(k)逆变换到频域,得到对应的广义互相关函数R12(n),R13(n),R14(n);
D、R12(n),R13(n),R14(n)分别取最大值时n所对应的时延即为3路声音信号x2(n)、x3(n)、x4(n)与基准信号x1(n)的时延估计t12、t13、t14;设R12(n)取最大值时的n值为n12,所取声音信号的点数为N,采样频率为Fs,若n12>N/2,则若n12≤N/2,则t13和t14与t12计算方法相同。
3.权利要求1或2所述声源定位方法的实现系统,其特征在于,包括至少4个MIC与GPS定位模块、存储模块、算法计算和系统控制模块、显示模块,至少4个所述MIC与GPS定位模块分别连接所述存储模块,所述存储模块、所述算法计算和系统控制模块、所述显示模块依次连接。
4.根据权利要求3所述的声源定位方法的实现系统,其特征在于,所述MIC与GPS定位模块包括麦克风及用于定位的GPS定位模块,麦克风实时获取声音信号,GPS定位模块实时获取时间信号和位置信号;所述存储模块用于存储获取的声音信号、时间信号和定位信号;所述算法计算和系统控制模块通过TDOA声音定位算法计算时延,列出方程组求解声源位置,包括声源的大地经度、大地纬度和大地高度;所述显示模块用于显示声源位置。
5.根据权利要求3所述的声源定位方法的实现系统,其特征在于,所述算法计算和系统控制模块为STM32开发平台,所述显示模块为液晶显示屏,所述GPS定位模块为北斗星通UM332。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710507959.8A CN107064878B (zh) | 2017-06-28 | 2017-06-28 | 一种基于高精度gps的声源定位方法及其实现系统 |
PCT/CN2017/104201 WO2019000680A1 (zh) | 2017-06-28 | 2017-09-29 | 一种基于高精度gps的声源定位方法及其实现系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710507959.8A CN107064878B (zh) | 2017-06-28 | 2017-06-28 | 一种基于高精度gps的声源定位方法及其实现系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107064878A CN107064878A (zh) | 2017-08-18 |
CN107064878B true CN107064878B (zh) | 2019-08-20 |
Family
ID=59613489
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710507959.8A Active CN107064878B (zh) | 2017-06-28 | 2017-06-28 | 一种基于高精度gps的声源定位方法及其实现系统 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN107064878B (zh) |
WO (1) | WO2019000680A1 (zh) |
Families Citing this family (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107064878B (zh) * | 2017-06-28 | 2019-08-20 | 山东大学 | 一种基于高精度gps的声源定位方法及其实现系统 |
JP6976131B2 (ja) * | 2017-10-16 | 2021-12-08 | 三菱重工サーマルシステムズ株式会社 | 空調システム及び空調制御方法 |
CN108919322B (zh) * | 2018-07-11 | 2022-07-08 | 南京航空航天大学 | 一种采用角度信息转换的定位解算方法 |
CN111010649A (zh) * | 2018-10-08 | 2020-04-14 | 阿里巴巴集团控股有限公司 | 拾音器和麦克风阵列 |
CN109471145B (zh) * | 2018-10-17 | 2022-12-06 | 中北大学 | 一种基于四元声阵列平台的双声定位定姿法 |
CN109507640A (zh) * | 2018-12-18 | 2019-03-22 | 重庆大学 | 一种基于实心球阵列的全方位等效源声源识别方法 |
CN109982038A (zh) * | 2019-03-15 | 2019-07-05 | 深圳市沃特沃德股份有限公司 | 显示声源位置的方法、装置及计算机设备 |
CN111308423B (zh) * | 2019-12-11 | 2022-05-24 | 中国人民解放军陆军工程大学 | 鲁棒声源定位系统及其方法 |
CN111610491B (zh) * | 2020-05-28 | 2022-12-02 | 东方智测(北京)科技有限公司 | 声源定位系统及方法 |
CN111812589A (zh) * | 2020-07-24 | 2020-10-23 | 江苏科技大学 | 一种基于声阵列的采煤机精确定位系统及其方法 |
CN111896916A (zh) * | 2020-07-24 | 2020-11-06 | 江苏科技大学 | 一种采煤机与液压支架相对位置测量系统及其方法 |
CN112004186A (zh) * | 2020-08-12 | 2020-11-27 | 中国计量大学 | 一种能够提高蓝牙aoa定位精度的系统 |
CN112911508A (zh) * | 2021-02-03 | 2021-06-04 | 贵州华图科技有限公司 | 一种高频声波林下定位方法和系统 |
CN112986914A (zh) * | 2021-02-10 | 2021-06-18 | 中国兵器装备集团自动化研究所 | 一种单兵头盔及其目标声源定位和声纹识别方法 |
CN114034380B (zh) * | 2021-11-11 | 2023-11-17 | 上汽大众汽车有限公司 | 一种用于发动机台架的一维声学定位方法 |
CN114280413B (zh) * | 2021-11-29 | 2024-02-09 | 山东信通电子股份有限公司 | 一种输电通道异常故障声音的定位方法及设备 |
CN114325586B (zh) * | 2021-12-31 | 2024-05-14 | 智己汽车科技有限公司 | 一种车载多媒体声音定位系统 |
CN114442143A (zh) * | 2022-01-25 | 2022-05-06 | 武汉新朗光电科技有限公司 | 基于音频的生命探测与定位系统、方法、设备和介质 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101483269B1 (ko) * | 2008-05-06 | 2015-01-21 | 삼성전자주식회사 | 로봇의 음원 위치 탐색 방법 및 그 장치 |
CN102749614A (zh) * | 2012-07-13 | 2012-10-24 | 浙江大学 | 一种基于静态声源辅助的声阵列网络自定位方法 |
CN103237345B (zh) * | 2013-04-09 | 2015-12-02 | 长安大学 | 一种基于二元量化数据的声源目标迭代定位方法 |
CN104181506B (zh) * | 2014-08-26 | 2016-08-17 | 山东大学 | 一种基于改进phat加权时延估计的声源定位方法及其实现系统 |
CN107064878B (zh) * | 2017-06-28 | 2019-08-20 | 山东大学 | 一种基于高精度gps的声源定位方法及其实现系统 |
-
2017
- 2017-06-28 CN CN201710507959.8A patent/CN107064878B/zh active Active
- 2017-09-29 WO PCT/CN2017/104201 patent/WO2019000680A1/zh active Application Filing
Also Published As
Publication number | Publication date |
---|---|
CN107064878A (zh) | 2017-08-18 |
WO2019000680A1 (zh) | 2019-01-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107064878B (zh) | 一种基于高精度gps的声源定位方法及其实现系统 | |
Fortunato et al. | Enabling high accuracy dynamic applications in urban environments using PPP and RTK on android multi-frequency and multi-GNSS smartphones | |
Chen et al. | A smart phone based PDR solution for indoor navigation | |
CN102158956B (zh) | 一种在无线传感器网络中基于rssi的改进加权三边定位方法 | |
CN102209386B (zh) | 一种室内无线定位方法及装置 | |
JP4920079B2 (ja) | Gps受信機を備えた地震測定システム | |
Chen et al. | Precise indoor positioning based on acoustic ranging in smartphone | |
CN108151747A (zh) | 一种利用声信号与惯性导航融合的室内定位系统及定位方法 | |
US20060009236A1 (en) | Determining a location | |
TW201344230A (zh) | 使用經調整往返時間測量的無線位置決定 | |
Bill et al. | Indoor and outdoor positioning in mobile environments a review and some investigations on wlan positioning | |
Mahmoud et al. | Integrated positioning for connected vehicles | |
KR20220104050A (ko) | 모바일 장치의 층 바닥 높이 추정 및 캘리브레이션 | |
CN104507097A (zh) | 一种基于WiFi位置指纹的半监督训练方法 | |
Angrisano et al. | Pedestrian localization with PDR supplemented by GNSS | |
Li et al. | Using two global positioning system satellites to improve wireless fidelity positioning accuracy in urban canyons | |
KR20080060502A (ko) | Gps 스위칭 중계기를 이용한 실내 측위시스템 및측위방법 | |
CN111060945B (zh) | 一种gnss/5g紧组合融合定位方法与装置 | |
CN111624552A (zh) | 一种基于声波渡越时间测量的地下管道定位系统及方法 | |
Groves et al. | Multi-epoch 3D mapping aided GNSS using a grid filter | |
CN206369546U (zh) | 一种基于智能手机的混合定位系统 | |
CN115979256A (zh) | 一种基于人工信标的多源协同位姿确定方法、装置及系统 | |
Ardakani et al. | A hybrid adaptive approach to improve position tracking measurements | |
Naghdi et al. | Assessing a UWB RTLS as a means for rapid WLAN radio map generation | |
CN113984003A (zh) | 一种基于北斗定位的杆塔沉降监测方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |