CN107390176A - 一种声源定位导航装置 - Google Patents
一种声源定位导航装置 Download PDFInfo
- Publication number
- CN107390176A CN107390176A CN201710452910.7A CN201710452910A CN107390176A CN 107390176 A CN107390176 A CN 107390176A CN 201710452910 A CN201710452910 A CN 201710452910A CN 107390176 A CN107390176 A CN 107390176A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- msup
- prime
- mtr
- 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.)
- Pending
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
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Other Investigation Or Analysis Of Materials By Electrical Means (AREA)
Abstract
本发明公开了一种声源定位导航装置,包括用于向装置本身进行供电的供电模块;所述供电模块连接有用于进行声源位置计算的主控模块;所述主控模块连接有用于信息接收的信息接收模块;本发明通过选取不同坐标系,在麦克风数量一定的情况下,利用各麦克风之间的时延能够更精确地计算出声源地坐标,在降低布线成本的同时增加了装置的精准性;并且,通过对设置语义识别装置和导航装置,能够可靠地实现语义识别、声源定位及导航,使本装置能够更为灵活地适应各种场景。
Description
技术领域
本发明涉及声源定位领域,特别是涉及一种声源定位导航装置。
背景技术
声源定位导航装置目前对于各个领域均有广泛应用,现有技术中,提高声源定位精度的方式主要是增加麦克风的数量,然而通过增加麦克风数量来提高精度的方式一来布线方式复杂,结构实现困难,同时也会增强麦克风的噪声信号干扰,因此,如何设置一个较优的麦克风阵列以及利用较优的算法,使在采用较少的麦克风,实现最好的识别效果,是现有领域中需要解决的问题。
现有技术中,缺少一种精确的声源定位导航装置;使声源定位在利用较少的麦克风数量实现更为精确的声源定位,并且不容易出现误差;同时也缺少一种能够实现语音识别并导航至声源位置的声源定位导航装置。
发明内容
有鉴于现有技术的上述缺陷,本发明所要解决的技术问题是提供一种精确的声源定位导航装置及控制方法;使声源定位在利用较少的麦克风数量实现更为精确的声源定位,并且不容易出现误差。
在解决上述问题的基础上,本发明还设置了语音识别模块和导航模块,使整体装置能够实现语音识别、声源定位及导航到声源位置三位一体的功能。
为实现上述目的,本发明提供了一种声源定位导航装置,包括供电模块;所述供电模块连接有用于进行声源位置计算的主控模块;所述主控模块连接有用于信息接收的信息接收模块。
所述信息接收模块包括由结构相同的第一麦克风、第二麦克风、第三麦克风、第四麦克风、第五麦克风、第六麦克风组成的麦克风阵列装置,所述第一麦克风、第二麦克风、第三麦克风、第四麦克风、第五麦克风、第六麦克风设置于同一平面并依次按照同一圆周均匀分布;以所述圆周圆心O为起点,所述第一至第六麦克风每相邻两个麦克风之间夹角α为60°。
所述第一麦克风与第二麦克风之间、第二麦克风与第三麦克风之间、所述第四麦克风与第五麦克风之间、第五麦克风与第六麦克风之间的距离L的范围为5-15cm。
所述用于声源位置计算的主控模块包括:用于统计不同信息接收端的时间延迟差的计时器;用于按照下列公式计算在以所述第一麦克风与第四麦克风的连线L1为x轴的第一坐标系中声源地位置的装置:
其中,D为所述第一麦克风与第四麦克风之间的距离;
c为声音传播速度;
t12为所述第二麦克风与第一麦克风之间接收到声音信号的时间差;
t13为所述第三麦克风与第一麦克风之间接收到声音信号的时间差;
t14为所述第四麦克风与第一麦克风之间接收到声音信号的时间差;
t15为所述第五麦克风与第一麦克风之间接收到声音信号的时间差;
t16为所述第六麦克风与第一麦克风之间接收到声音信号的时间差;
x0为在第一坐标系中声源地的x轴坐标;
y0为在第一坐标系中声源地的y轴坐标;
z0为第一坐标系中声源地的z轴坐标;
r0为声源地距原点O的距离,即声源地的球坐标值;
x1、x2、x3为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1、y2为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r0。
较佳的,所述用于声源位置计算的主控模块还包括:
用于按照下列公式计算在以所述第二麦克风与第五麦克风的连线L2为x轴的第二坐标系中声源地位置的装置;
其中,D为所述第二麦克风与第五麦克风之间的距离;
c为声音传播速度;
t23为所述第三麦克风与第二麦克风之间接收到声音信号的时间差;
t24为所述第四麦克风与第二麦克风之间接收到声音信号的时间差;
t25为所述第五麦克风与第二麦克风之间接收到声音信号的时间差;
t26为所述第六麦克风与第二麦克风之间接收到声音信号的时间差;
t21为所述第一麦克风与第二麦克风之间接收到声音信号的时间差;
x'为在所述第二坐标系中声源地的x轴坐标;
y'为在所述第二坐标系中声源地的y轴坐标;
z'为在所述第二坐标系中声源地的z轴坐标;
r'为声源地距原点O的距离,即声源地的球坐标值;
x1'、x2'、x3'为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1'、y2'为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1'为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r”。
用于按照下列公式将第二坐标系中计算的声源地坐标换算为第一坐标系中声源地坐标的装置;
其中,x'为在所述第二坐标系中声源地的x轴坐标;
y'为在所述第二坐标系中声源地的y轴坐标;
x0'为将所述第二坐标系中声源地的x轴坐标在第一坐标系中换算后声源地位置的x轴坐标;
y0'为将所述第二坐标系中声源地的y轴坐标在第一坐标系中换算后声源地位置的y轴坐标;
用于按照下列公式将x'、x0取平均值进而取得在第一坐标系中声源地的x轴坐标的装置;
用于按照下列公式将y'、y0取平均值进而取得在第一坐标系中声源地的y轴坐标的装置;
其中,xa为第一坐标系中的声源地x轴最终坐标;
ya为第一坐标系中的声源地y轴最终坐标;
za为第一坐标系中的声源地z轴最终坐标;
用于按照以下公式计算声源地的球坐标值的装置:
其中,为最终输出的所述声源地位置的方位角;
θa为最终输出的声源地位置的俯仰角;
ra为最终输出的声源地位置距离原点的距离。
较佳的,所述用于声源地位置计算的主控模块还包括:
用于按照下列公式计算在以所述第六麦克风与第三麦克风的连线(L3)为x轴的第三坐标系中声源地位置的装置;
其中,D为第三麦克风与第六麦克风之间的距离;
c为声音传播速度;
t61为所述第一麦克风与第六麦克风之间接收到声音信号的时间差;
t62为所述第二麦克风与第六麦克风之间接收到声音信号的时间差;
t63为所述第三麦克风与第六麦克风之间接收到声音信号的时间差;
t64为所述第四麦克风与第六麦克风之间接收到声音信号的时间差;
t65为所述第五麦克风与第六麦克风之间接收到声音信号的时间差;
x”为在所述第三坐标系中声源地的x轴坐标;
y”为在所述第三坐标系中声源地的y轴坐标;
z”为在所述第三坐标系中声源地的z轴坐标;
r”为声源地距离第一麦克风与第四麦克风的中点的距离,即声源地的球坐标值;
x1”、x2”、x3”为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1”、y2”为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1”为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r”;
用于按照下列公式进行声源地计算的装置;
其中,x”为在所述第二坐标系中声源地的x轴坐标;
y”为在所述第二坐标系中声源地的y轴坐标;
x0”为将所述第二坐标系中声源地的x轴坐标在第一坐标系中换算后声源地位置的x轴坐标;
y0”为将所述第二坐标系中声源地的y轴坐标在第一坐标系中换算后声源地位置的y轴坐标;
用于按照下列公式进行声源地位置计算的装置:
xb为第一坐标系中的声源地x轴最终坐标;
yb为第一坐标系中的声源地y轴最终坐标;
zb为第一坐标系中的声源地z轴最终坐标;
用于按照以下公式计算声源地的球坐标值的装置:
其中,为最终输出的所述声源地的方位角;
θb为最终输出的声源地的俯仰角;
rb为最终输出的声源地距离原点的距离。
较佳的,所述用于声源位置计算的主控模块还包括:
用于按照下列公式计算在以所述第二麦克风与第五麦克风的连线L2为x轴的第二坐标系中声源地位置的装置;
其中,D为第二麦克风与第五麦克风之间的距离;
c为声音传播速度;
t23为所述第三麦克风与第二麦克风之间接收到声音信号的时间差;
t24为所述第四麦克风与第二麦克风之间接收到声音信号的时间差;
t25为所述第五麦克风与第二麦克风之间接收到声音信号的时间差;
t26为所述第六麦克风与第二麦克风之间接收到声音信号的时间差;
t21为所述第一麦克风与第二麦克风之间接收到声音信号的时间差;
x'为在所述第二坐标系中声源地的x轴坐标;
y'为在所述第二坐标系中声源地的y轴坐标;
z'为在所述第二坐标系中声源地的z轴坐标;
r'为声源地距原点O的距离,即声源地的球坐标值;
x1'、x2'、x3'为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1'、y2'为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1'为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r”。
用于按照下列公式计算在以所述第六麦克风与第三麦克风的连线(L3)为x轴的第三坐标系中声源地位置的装置;
其中,D为第三麦克风与第六麦克风之间的距离;
c为声音传播速度;
t61为所述第一麦克风与第六麦克风之间接收到声音信号的时间差;
t62为所述第二麦克风与第六麦克风之间接收到声音信号的时间差;
t63为所述第三麦克风与第六麦克风之间接收到声音信号的时间差;
t64为所述第四麦克风与第六麦克风之间接收到声音信号的时间差;
t65为所述第五麦克风与第六麦克风之间接收到声音信号的时间差;
x”为在所述第三坐标系中声源地的x轴坐标;
y”为在所述第三坐标系中声源地的y轴坐标;
z”为在所述第三坐标系中声源地的z轴坐标;
r”为声源地距离第一麦克风与第四麦克风的中点的距离,即声源地的球坐标值;
x1”、x2”、x3”为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1”、y2”为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1”为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r”;
用于按照下列公式进行声源地计算的装置;
其中,x0'为将所述第二坐标系中声源地的x轴坐标在第一坐标系中换算后声源地位置的x轴坐标;
y0'为将所述第二坐标系中声源地的y轴坐标在第一坐标系中换算后声源地位置的y轴坐标;
用于按照下列公式进行声源地计算的装置;
其中,x0”为将所述第三坐标系中声源地的x轴坐标在第一坐标系中换算后声源地位置的x轴坐标;
y0”为所述第三坐标系中声源地的y轴坐标在第一坐标系中换算后声源地位置的y轴坐标;
用于按照下列公式进行声源地计算的装置:
其中,x为第一坐标系中的声源地x轴最终坐标;
y为第一坐标系中的声源地y轴最终坐标;
z为第一坐标系中的声源地z轴最终坐标;
用于按照以下公式计算声源地的球坐标值的装置:
其中,为最终输出的所述声源地的方位角;
θ为最终输出的声源地的俯仰角;
r为最终输出的声源地距离原点的距离。
较佳的,所述声源定位导航装置还包括用于声源地位置信息输出的输出模块。
较佳的,所述声源定位导航装置还包括用于识别声源语义的装置;还包括用于识别语义后向声源进行导航的装置。
较佳的,所述识别声源语义的装置,包括:用于降噪消回音的装置;用于连接网络将语音信息转化为文字信息的装置;用于调用语义解析库对文字信息进行解析的装置。
较佳的,所述用于识别语义后向声源进行导航的装置包括用于判断是否接收到机器人执行声源定位行走的命令信息装置;如果不是,则用于回到信息接收的装置;如果是,则用于计算声源位置的装置;用于输入电机正反转信号执行运动到声源位置的装置。
较佳的,述用于调用所述语义解析库对文字信息进行解析的装置;包括:用于收集大量语句,将语句进行分类,然后训练事件分类模型的装置;用于将语句通过条件随机场分词器进行分词以及词位标注的装置;用于通过训练语义解析模型,实现对语句语义的理解的装置。
本发明的有益效果是:通过选取不同坐标系,在麦克风数量一定的情况下,利用各麦克风之间的时延能够更精确地计算出声源地坐标,在降低布线成本的同时增加了装置的精准性;并且,通过对设置语义识别装置和导航装置,能够可靠地实现语义识别、声源定位及导航,使本装置能够更为灵活地适应各种场景。
附图说明
图1是本发明一具体实施方式的结构示意图。
图2是麦克风阵列布置示意图。
图3是是在第一坐标系声源地位置的模拟示意图。
图4是在第二坐标系中声源地位置的模拟示意图。
图5是在第三坐标系中声源地位置的模拟示意图。
图6是本发明实现声源定位和导航的流程图。
具体实施方式
下面结合附图和实施例对本发明作进一步说明:
如图1至图6所示,一种声源定位导航装置,包括用于向装置本身进行供电的供电模块;供电模块连接有用于进行声源位置计算的主控模块;主控模块连接有用于信息接收的信息接收模块。
如图2,信息接收模块包括由结构相同的第一麦克风S1、第二麦克风S2、第三麦克风S3、第四麦克风S4、第五麦克风S5、第六麦克风S6组成的麦克风阵列装置,第一麦克风S1、第二麦克风S2、第三麦克风S3、第四麦克风S4、第五麦克风S5、第六麦克风S6设置于同一平面并依次按照同一圆周均匀分布;以圆周圆心O为起点,第一至第六麦克风S6每相邻两个麦克风之间夹角α为60°。
第一麦克风S1与第二麦克风S2之间、第二麦克风S2与第三麦克风S3之间、第四麦克风S4与第五麦克风S5之间、第五麦克风S5与第六麦克风S6之间的距离L为5cm。
其他方案中,也可以将相邻两个麦克风之间的距离L设置为5-15cm中的其他值,以达到相同的技术效果,如6cm,7cm,8cm,9cm,10cm,11cm,12cm,13cm,14cm,15cm。
如图3,用于声源地位置计算的主控模块包括:用于统计不同信息接收端的时间延迟差的计时器;用于按照下列公式计算在以第一麦克风S1与第四麦克风S4的连线L1为x轴的第一坐标系中声源地位置的装置:
其中,D为第一麦克风S1与第四麦克风S4之间的距离;
c为声音传播速度;
t12为第二麦克风S2与第一麦克风S1之间接收到声音信号的时间差;
t13为第三麦克风S3与第一麦克风S1之间接收到声音信号的时间差;
t14为第四麦克风S4与第一麦克风S1之间接收到声音信号的时间差;
t15为第五麦克风S5与第一麦克风S1之间接收到声音信号的时间差;
t16为第六麦克风S6与第一麦克风S1之间接收到声音信号的时间差;
x0为在第一坐标系中声源地的x轴坐标;
y0为在第一坐标系中声源地的y轴坐标;
z0为第一坐标系中声源地的z轴坐标;
r0为声源地距原点O的距离,即声源地的球坐标值;
x1、x2、x3为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1、y2为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r0。
如图4,用于声源地位置计算的主控模块还包括:用于按照下列公式计算在以第二麦克风S2与第五麦克风S5的连线L2为x轴的第二坐标系中声源地位置的装置;
其中,D为第二麦克风S2与第五麦克风S5之间的距离;
c为声音传播速度;
t23为第三麦克风S3与第二麦克风S2之间接收到声音信号的时间差;
t24为第四麦克风S4与第二麦克风S2之间接收到声音信号的时间差;
t25为第五麦克风S5与第二麦克风S2之间接收到声音信号的时间差;
t26为第六麦克风S6与第二麦克风S2之间接收到声音信号的时间差;
t21为第一麦克风S1与第二麦克风S2之间接收到声音信号的时间差;
x'为在第二坐标系中声源地的x轴坐标;
y'为在第二坐标系中声源地的y轴坐标;
z'为在第二坐标系中声源地的z轴坐标;
r'为声源地距原点O的距离,即声源地的球坐标值;
x1'、x2'、x3'为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1'、y2'为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1'为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r”。
用于按照下列公式将第二坐标系中计算的声源地坐标换算为第一坐标系中声源地坐标的装置;
其中,x'为在第二坐标系中声源地的x轴坐标;
y'为在第二坐标系中声源地的y轴坐标;
x0'为将第二坐标系中声源地的x轴坐标在第一坐标系中换算后声源地的x轴坐标;
y0'为将第二坐标系中声源地的y轴坐标在第一坐标系中换算后声源地的y轴坐标;
用于按照下列公式将x'、x0取平均值进而取得在第一坐标系中声源地的x轴坐标的装置;
用于按照下列公式将y'、y0取平均值进而取得在第一坐标系中声源地的y轴坐标的装置;
其中,xa为第一坐标系中的声源地x轴最终坐标;
ya为第一坐标系中的声源地y轴最终坐标;
za为第一坐标系中的声源地z轴最终坐标;
用于按照以下公式计算声源地的球坐标值的装置:
其中,为最终输出的声源地位置的方位角;
θa为最终输出的声源地位置的俯仰角;
ra为最终输出的声源地位置距离原点的距离。
如图5,用于声源地位置计算的主控模块还包括:
用于按照下列公式计算在以所述第六麦克风与第三麦克风的连线(L3)为x轴的第三坐标系中声源地位置的装置;
其中,D为第三麦克风与第六麦克风之间的距离;
c为声音传播速度;
t61为所述第一麦克风与第六麦克风之间接收到声音信号的时间差;
t62为所述第二麦克风与第六麦克风之间接收到声音信号的时间差;
t63为所述第三麦克风与第六麦克风之间接收到声音信号的时间差;
t64为所述第四麦克风与第六麦克风之间接收到声音信号的时间差;
t65为所述第五麦克风与第六麦克风之间接收到声音信号的时间差;
x”为在所述第三坐标系中声源地的x轴坐标;
y”为在所述第三坐标系中声源地的y轴坐标;
z”为在所述第三坐标系中声源地的z轴坐标;
r”为声源地距离第一麦克风与第四麦克风的中点的距离,即声源地的球坐标值;
x1”、x2”、x3”为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1”、y2”为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1”为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r”;
用于按照下列公式进行声源地计算的装置;
其中,x”为在第三坐标系中声源地的x轴坐标;
y”为在第三坐标系中声源地的y轴坐标;
x0”为将第三坐标系中声源地的x轴坐标在第一坐标系中换算后声源地位置的x轴坐标;
y0”为将第三坐标系中声源地的y轴坐标在第一坐标系中换算后声源地位置的y轴坐标;
用于按照下列公式进行声源地位置计算的装置:
xb为第一坐标系中的声源地x轴最终坐标;
yb为第一坐标系中的声源地y轴最终坐标;
zb为第一坐标系中的声源地z轴最终坐标;
用于按照以下公式计算声源地的球坐标值的装置:
其中,为最终输出的所述声源地的方位角;
θb为最终输出的声源地的俯仰角;
rb为最终输出的声源地距离原点的距离。
如图3至图5,用于声源位置计算的主控模块还包括:
用于按照下列公式计算在以第二麦克风S2与第五麦克风S5的连线L2为x轴的第二坐标系中声源地位置的装置;
其中,D为第二麦克风S2与第五麦克风S5之间的距离;
c为声音传播速度;
t23为第三麦克风S3与第二麦克风S2之间接收到声音信号的时间差;
t24为第四麦克风S4与第二麦克风S2之间接收到声音信号的时间差;
t25为第五麦克风S5与第二麦克风S2之间接收到声音信号的时间差;
t26为第六麦克风S6与第二麦克风S2之间接收到声音信号的时间差;
t21为第一麦克风S1与第二麦克风S2之间接收到声音信号的时间差;
x'为在第二坐标系中声源地的x轴坐标;
y'为在第二坐标系中声源地的y轴坐标;
z'为在第二坐标系中声源地的z轴坐标;
r'为声源地距离第一麦克风S1与第四麦克风S4的中点的距离,即声源地位置的球坐标值;
x1'、x2'、x3'为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1'、y2'为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1'为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r”;
用于按照下列公式计算在以所述第六麦克风与第三麦克风的连线(L3)为x轴的第三坐标系中声源地位置的装置;
其中,D为第三麦克风与第六麦克风之间的距离;
c为声音传播速度;
t61为所述第一麦克风与第六麦克风之间接收到声音信号的时间差;
t62为所述第二麦克风与第六麦克风之间接收到声音信号的时间差;
t63为所述第三麦克风与第六麦克风之间接收到声音信号的时间差;
t64为所述第四麦克风与第六麦克风之间接收到声音信号的时间差;
t65为所述第五麦克风与第六麦克风之间接收到声音信号的时间差;
x”为在所述第三坐标系中声源地的x轴坐标;
y”为在所述第三坐标系中声源地的y轴坐标;
z”为在所述第三坐标系中声源地的z轴坐标;
r”为声源地距离第一麦克风与第四麦克风的中点的距离,即声源地的球坐标值;
x1”、x2”、x3”为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1”、y2”为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1”为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r”;
用于按照下列公式进行声源地计算的装置;
其中,x0'为将第二坐标系中声源地的x轴坐标在第一坐标系中换算后声源地位置的x轴坐标;
y0'为将第二坐标系中声源地的y轴坐标在第一坐标系中换算后声源地位置的y轴坐标;
用于按照下列公式进行声源地计算的装置;
其中,x0”为将第三坐标系中声源地的x轴坐标在第一坐标系中换算后声源地位置的x轴坐标;
y0”为第三坐标系中声源地的y轴坐标在第一坐标系中换算后声源地位置的y轴坐标;
用于按照下列公式进行声源地计算的装置:
其中,x为第一坐标系中的声源地x轴最终坐标;
y为第一坐标系中的声源地y轴最终坐标;
z为第一坐标系中的声源地z轴最终坐标;
用于按照以下公式计算声源地的球坐标值的装置:
其中,为最终输出的声源地方位角;
θ为最终输出的声源地俯仰角;
r为最终输出的声源地距原点O的距离。
如图6,所述声源导航装置还包括用于声源地位置信息输出的输出模块;用于识别声源语义的装置;用于识别语义后向声源进行导航的装置。
识别声源语义的装置,包括:用于降噪消回音的装置;用于连接网络将语音信息转化为文字信息的装置;用于调用语义解析库对文字信息进行解析的装置;用于识别语义后向声源进行导航的装置包括:用于判断是否接收到机器人执行声源定位行走的命令信息装置;如果不是,则用于回到信息接收的装置;如果是,则用于计算声源位置的装置;用于输入电机正反转信号执行运动到声源位置的装置。
用于调用所述语义解析库对文字信息进行解析的装置;包括用于收集大量语句,将语句进行分类,然后训练事件分类模型的装置;用于将语句通过条件随机场分词器进行分词以及词位标注的装置;用于通过训练语义解析模型,实现对语句语义的理解的装置。
以上详细描述了本发明的较佳具体实施例。应当理解,本领域的普通技术人员无需创造性劳动就可以根据本发明的构思作出诸多修改和变化。因此,凡本技术领域中技术人员依本发明的构思在现有技术的基础上通过逻辑分析、推理或者有限的实验可以得到的技术方案,皆应在由权利要求书所确定的保护范围内。
Claims (9)
1.一种声源定位导航装置,其特征是:包括用于向装置本身进行供电的供电模块;所述供电模块连接有用于进行声源位置计算的主控模块;所述主控模块连接有用于信息接收的信息接收模块;
所述信息接收模块包括由结构相同的第一麦克风、第二麦克风、第三麦克风、第四麦克风、第五麦克风、第六麦克风组成的麦克风阵列装置,所述第一麦克风、第二麦克风、第三麦克风、第四麦克风、第五麦克风、第六麦克风设置于同一平面并依次按照同一直径的圆周均匀分布;以所述圆周圆心(O)为起点,所述第一至第六麦克风每相邻两个麦克风之间夹角(α)为60°;
所述第一麦克风至第六麦克风每相邻两个麦克风之间的距离(L)的范围为5-15cm。
2.如权利要求1所述的声源定位导航装置,其特征是:所述用于声源地位置计算的主控模块包括:
用于统计不同信息接收端的时间延迟差的计时器;
用于按照下列公式计算在以所述第一麦克风与第四麦克风的连线(L1)为x轴的第一坐标系中声源地位置的装置:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msubsup>
<mi>t</mi>
<mn>12</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mn>2</mn>
<msubsup>
<mi>t</mi>
<mn>16</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>14</mn>
<mn>2</mn>
</msubsup>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>t</mi>
<mn>14</mn>
</msub>
<mo>-</mo>
<mn>4</mn>
<msub>
<mi>t</mi>
<mn>12</mn>
</msub>
<mo>-</mo>
<mn>4</mn>
<msub>
<mi>t</mi>
<mn>16</mn>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<msub>
<mi>t</mi>
<mn>14</mn>
</msub>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<msubsup>
<mi>t</mi>
<mn>14</mn>
<mn>2</mn>
</msubsup>
</mrow>
<mrow>
<mn>2</mn>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>13</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>12</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>13</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>12</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mi>D</mi>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>15</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>16</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>15</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>16</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mi>D</mi>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>16</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>12</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>16</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>12</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>15</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>13</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>15</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>13</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
</mrow>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
</mrow>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>r</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msubsup>
<mi>x</mi>
<mn>0</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>r</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mo>-</mo>
<mfrac>
<mi>D</mi>
<mn>2</mn>
</mfrac>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>z</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msubsup>
<mi>r</mi>
<mn>0</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>x</mi>
<mn>0</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>y</mi>
<mn>0</mn>
<mn>2</mn>
</msubsup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,D为所述第一麦克风与第四麦克风之间的距离;
c为声音传播速度;
t12为所述第二麦克风与第一麦克风之间接收到声音信号的时间差;
t13为所述第三麦克风与第一麦克风之间接收到声音信号的时间差;
t14为所述第四麦克风与第一麦克风之间接收到声音信号的时间差;
t15为所述第五麦克风与第一麦克风之间接收到声音信号的时间差;
t16为所述第六麦克风与第一麦克风之间接收到声音信号的时间差;
x0为在第一坐标系中声源地的x轴坐标;
y0为在第一坐标系中声源地的y轴坐标;
z0为第一坐标系中声源地的z轴坐标;
r0为声源地距离第一麦克风与第四麦克风的中点的距离;
x1、x2、x3为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1、y2为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r0。
3.如权利要求2所述的声源定位导航装置,其特征是:所述用于声源地位置计算的主控模块还包括:
用于按照下列公式计算在以所述第二麦克风与第五麦克风的连线(L2)为x轴的第二坐标系中声源地位置的装置;
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msubsup>
<mi>t</mi>
<mn>23</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mn>2</mn>
<msubsup>
<mi>t</mi>
<mn>21</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>25</mn>
<mn>2</mn>
</msubsup>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>t</mi>
<mn>25</mn>
</msub>
<mo>-</mo>
<mn>4</mn>
<msub>
<mi>t</mi>
<mn>23</mn>
</msub>
<mo>-</mo>
<mn>4</mn>
<msub>
<mi>t</mi>
<mn>21</mn>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<msub>
<mi>t</mi>
<mn>25</mn>
</msub>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<msubsup>
<mi>t</mi>
<mn>25</mn>
<mn>2</mn>
</msubsup>
</mrow>
<mrow>
<mn>2</mn>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>24</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>23</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>24</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>23</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mi>D</mi>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>26</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>21</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>26</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>21</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mi>D</mi>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mo>&CenterDot;</mo>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>21</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>23</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>21</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>23</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mo>&CenterDot;</mo>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>26</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>24</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>26</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>24</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>x</mi>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>&prime;</mo>
</msup>
</mrow>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>y</mi>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mo>&prime;</mo>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>r</mi>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>-</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>x</mi>
<mo>&prime;</mo>
</msup>
<mo>-</mo>
<mfrac>
<mi>D</mi>
<mn>2</mn>
</mfrac>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>z</mi>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mi>r</mi>
<mrow>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>-</mo>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>-</mo>
<msup>
<mi>y</mi>
<mrow>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,D为所述第二麦克风与第五麦克风之间的距离;
c为声音传播速度;
t23为所述第三麦克风与第二麦克风之间接收到声音信号的时间差;
t24为所述第四麦克风与第二麦克风之间接收到声音信号的时间差;
t25为所述第五麦克风与第二麦克风之间接收到声音信号的时间差;
t26为所述第六麦克风与第二麦克风之间接收到声音信号的时间差;
t21为所述第一麦克风与第二麦克风之间接收到声音信号的时间差;
x'为在所述第二坐标系中声源地的x轴坐标;
y'为在所述第二坐标系中声源地的y轴坐标;
z'为在所述第二坐标系中声源地的z轴坐标;
r'为声源地距离所述第一麦克风与第四麦克风的中点的距离,即声源地的球坐标值;
x1'、x2'、x3'为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1'、y2'为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1'为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r”;
用于按照下列公式将第二坐标系中计算的声源地坐标换算为第一坐标系中声源地坐标的装置;
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msup>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<mi>x</mi>
<mo>&prime;</mo>
</msup>
<mo>-</mo>
<msqrt>
<mn>3</mn>
</msqrt>
<msup>
<mi>y</mi>
<mo>&prime;</mo>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<msup>
<mi>x</mi>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msup>
<mi>y</mi>
<mo>&prime;</mo>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,x'为在所述第二坐标系中声源地的x轴坐标;
y'为在所述第二坐标系中声源地的y轴坐标;
x0'为将所述第二坐标系中声源地的x轴坐标在第一坐标系中换算后声源地的x轴坐标;
y0'为将所述第二坐标系中声源地的y轴坐标在第一坐标系中换算后声源地的y轴坐标;
用于按照下列公式将x'、x0取平均值进而取得在第一坐标系中声源地的x轴坐标的装置;
用于按照下列公式将y'、y0取平均值进而取得在第一坐标系中声源地的y轴坐标的装置;
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msub>
<mi>x</mi>
<mi>a</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mo>&prime;</mo>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>y</mi>
<mi>a</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
<mo>&prime;</mo>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mi>a</mi>
</msub>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<msup>
<msub>
<mi>z</mi>
<mn>0</mn>
</msub>
<mo>&prime;</mo>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,xa为第一坐标系中的声源地x轴最终坐标;
ya为第一坐标系中的声源地y轴最终坐标;
za为第一坐标系中的声源地z轴最终坐标;
用于按照以下公式计算声源地的球坐标值的装置:
其中,为最终输出的所述声源地位置的方位角;
θa为最终输出的声源地位置的俯仰角;
ra为最终输出的声源地位置距离原点的距离。
4.如权利要求2所述的声源定位导航装置,其特征是:所述用于声源地位置计算的主控模块还包括:
用于按照下列公式计算在以所述第六麦克风与第三麦克风的连线(L3)为x轴的第三坐标系中声源地位置的装置;
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msubsup>
<mi>t</mi>
<mn>61</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mn>2</mn>
<msubsup>
<mi>t</mi>
<mn>65</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>63</mn>
<mn>2</mn>
</msubsup>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>t</mi>
<mn>63</mn>
</msub>
<mo>-</mo>
<mn>4</mn>
<msub>
<mi>t</mi>
<mn>61</mn>
</msub>
<mo>-</mo>
<mn>4</mn>
<msub>
<mi>t</mi>
<mn>65</mn>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<msub>
<mi>t</mi>
<mn>63</mn>
</msub>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<msubsup>
<mi>t</mi>
<mn>63</mn>
<mn>2</mn>
</msubsup>
</mrow>
<mrow>
<mn>2</mn>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>62</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>61</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>62</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>61</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mi>D</mi>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>64</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>65</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>64</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>65</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mi>D</mi>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mo>&CenterDot;</mo>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>65</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>61</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>65</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>61</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mo>&CenterDot;</mo>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>64</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>62</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>64</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>62</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
</mrow>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>y</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>r</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>-</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>-</mo>
<mfrac>
<mi>D</mi>
<mn>2</mn>
</mfrac>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>z</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mi>r</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>-</mo>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>-</mo>
<msup>
<mi>y</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,D为第三麦克风与第六麦克风之间的距离;
c为声音传播速度;
t61为所述第一麦克风与第六麦克风之间接收到声音信号的时间差;
t62为所述第二麦克风与第六麦克风之间接收到声音信号的时间差;
t63为所述第三麦克风与第六麦克风之间接收到声音信号的时间差;
t64为所述第四麦克风与第六麦克风之间接收到声音信号的时间差;
t65为所述第五麦克风与第六麦克风之间接收到声音信号的时间差;
x”为在所述第三坐标系中声源地的x轴坐标;
y”为在所述第三坐标系中声源地的y轴坐标;
z”为在所述第三坐标系中声源地的z轴坐标;
r”为声源地距离第一麦克风与第四麦克风的中点的距离,即声源地的球坐标值;
x1”、x2”、x3”为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1”、y2”为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1”为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r”;
用于按照下列公式进行声源地计算的装置;
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msup>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msqrt>
<mn>3</mn>
</msqrt>
<msup>
<mi>y</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mo>-</mo>
<msqrt>
<mn>3</mn>
</msqrt>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msup>
<mi>y</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,x”为在所述第三坐标系中声源地的x轴坐标;
y”为在所述第三坐标系中声源地的y轴坐标;
x0”为将所述第三坐标系中声源地的x轴坐标在第一坐标系中换算后声源地位置的x轴坐标;
y0”为将所述第三坐标系中声源地的y轴坐标在第一坐标系中换算后声源地位置的y轴坐标;
用于按照下列公式进行声源地位置计算的装置:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msub>
<mi>x</mi>
<mi>b</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
</mrow>
<mn>2</mn>
</mfrac>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>y</mi>
<mi>b</mi>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
</mrow>
<mn>2</mn>
</mfrac>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>z</mi>
<mi>b</mi>
</msub>
<mo>=</mo>
<msup>
<msub>
<mi>z</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>0</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
xb为第一坐标系中的声源地x轴最终坐标;
yb为第一坐标系中的声源地y轴最终坐标;
zb为第一坐标系中的声源地z轴最终坐标;
用于按照以下公式计算声源地的球坐标值的装置:
其中,为最终输出的所述声源地的方位角;
θb为最终输出的声源地的俯仰角;
rb为最终输出的声源地距离原点的距离。
5.如权利要求2所述的声源定位导航装置,其特征是:所述用于声源位置计算的主控模块还包括:
用于按照下列公式计算在以所述第二麦克风与第五麦克风的连线(L2)为x轴的第二坐标系中声源地位置的装置;
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msubsup>
<mi>t</mi>
<mn>23</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mn>2</mn>
<msubsup>
<mi>t</mi>
<mn>21</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>25</mn>
<mn>2</mn>
</msubsup>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>t</mi>
<mn>25</mn>
</msub>
<mo>-</mo>
<mn>4</mn>
<msub>
<mi>t</mi>
<mn>23</mn>
</msub>
<mo>-</mo>
<mn>4</mn>
<msub>
<mi>t</mi>
<mn>21</mn>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<msub>
<mi>t</mi>
<mn>25</mn>
</msub>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<msubsup>
<mi>t</mi>
<mn>25</mn>
<mn>2</mn>
</msubsup>
</mrow>
<mrow>
<mn>2</mn>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>24</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>23</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>24</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>23</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mi>D</mi>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>26</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>21</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>26</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>21</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mi>D</mi>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mo>&CenterDot;</mo>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>21</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>23</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>21</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>23</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mo>&CenterDot;</mo>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>26</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>24</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>26</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>24</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>x</mi>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>&prime;</mo>
</msup>
</mrow>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>y</mi>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mo>&prime;</mo>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>r</mi>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>-</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>x</mi>
<mo>&prime;</mo>
</msup>
<mo>-</mo>
<mfrac>
<mi>D</mi>
<mn>2</mn>
</mfrac>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>z</mi>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mi>r</mi>
<mrow>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>-</mo>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>-</mo>
<msup>
<mi>y</mi>
<mrow>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,D为第二麦克风与第五麦克风之间的距离;
c为声音传播速度;
t23为所述第三麦克风与第二麦克风之间接收到声音信号的时间差;
t24为所述第四麦克风与第二麦克风之间接收到声音信号的时间差;
t25为所述第五麦克风与第二麦克风之间接收到声音信号的时间差;
t26为所述第六麦克风与第二麦克风之间接收到声音信号的时间差;
t21为所述第一麦克风与第二麦克风之间接收到声音信号的时间差;
x'为在所述第二坐标系中声源地的x轴坐标;
y'为在所述第二坐标系中声源地的y轴坐标;
z'为在所述第二坐标系中声源地的z轴坐标;
r'为声源地距离第一麦克风与第四麦克风的中点的距离,即声源地位置的球坐标值;
x1'、x2'、x3'为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1'、y2'为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1'为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r”;
用于按照下列公式计算在以所述第六麦克风与第三麦克风的连线(L3)为x轴的第三坐标系中声源地位置的装置;
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msubsup>
<mi>t</mi>
<mn>61</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mn>2</mn>
<msubsup>
<mi>t</mi>
<mn>65</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>63</mn>
<mn>2</mn>
</msubsup>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>t</mi>
<mn>63</mn>
</msub>
<mo>-</mo>
<mn>4</mn>
<msub>
<mi>t</mi>
<mn>61</mn>
</msub>
<mo>-</mo>
<mn>4</mn>
<msub>
<mi>t</mi>
<mn>65</mn>
</msub>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<msub>
<mi>t</mi>
<mn>63</mn>
</msub>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<msubsup>
<mi>t</mi>
<mn>63</mn>
<mn>2</mn>
</msubsup>
</mrow>
<mrow>
<mn>2</mn>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>62</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>61</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>62</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>61</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mi>D</mi>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>64</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>65</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>64</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>65</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mi>D</mi>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mo>&CenterDot;</mo>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>65</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>61</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>65</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>61</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mn>2</mn>
<mo>&CenterDot;</mo>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<mi>c</mi>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>t</mi>
<mn>64</mn>
</msub>
<mo>-</mo>
<msub>
<mi>t</mi>
<mn>62</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msup>
<mi>c</mi>
<mn>2</mn>
</msup>
<mo>&CenterDot;</mo>
<mrow>
<mo>(</mo>
<msubsup>
<mi>t</mi>
<mn>64</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>t</mi>
<mn>62</mn>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>D</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
</mrow>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>y</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>r</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>r</mi>
<mn>1</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>-</mo>
<msup>
<mrow>
<mo>(</mo>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>-</mo>
<mfrac>
<mi>D</mi>
<mn>2</mn>
</mfrac>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>z</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mi>r</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>-</mo>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
<mo>-</mo>
<msup>
<mi>y</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
<mn>2</mn>
</mrow>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,D为第三麦克风与第六麦克风之间的距离;
c为声音传播速度;
t61为所述第一麦克风与第六麦克风之间接收到声音信号的时间差;
t62为所述第二麦克风与第六麦克风之间接收到声音信号的时间差;
t63为所述第三麦克风与第六麦克风之间接收到声音信号的时间差;
t64为所述第四麦克风与第六麦克风之间接收到声音信号的时间差;
t65为所述第五麦克风与第六麦克风之间接收到声音信号的时间差;
x”为在所述第三坐标系中声源地的x轴坐标;
y”为在所述第三坐标系中声源地的y轴坐标;
z”为在所述第三坐标系中声源地的z轴坐标;
r”为声源地距离第一麦克风与第四麦克风的中点的距离,即声源地的球坐标值;
x1”、x2”、x3”为计算过程产生的中间变量,根据该变量值以及上述公式能够计算出声源地的坐标值x0;
y1”、y2”为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值y0;
r1”为计算过程产生的中间变量,根据上述公式能够计算出声源地的球坐标值r”;
用于按照下列公式进行声源地计算的装置;
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msup>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<mi>x</mi>
<mo>&prime;</mo>
</msup>
<mo>-</mo>
<msqrt>
<mn>3</mn>
</msqrt>
<msup>
<mi>y</mi>
<mo>&prime;</mo>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<msup>
<mi>x</mi>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msup>
<mi>y</mi>
<mo>&prime;</mo>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mtd>
</mtr>
</mtable>
</mfenced>
7
其中,x0'为将所述第二坐标系中声源地的x轴坐标在第一坐标系中换算后声源地位置的x轴坐标;
y0'为将所述第二坐标系中声源地的y轴坐标在第一坐标系中换算后声源地位置的y轴坐标;
用于按照下列公式进行声源地计算的装置;
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msup>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msqrt>
<mn>3</mn>
</msqrt>
<msup>
<mi>y</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mtd>
</mtr>
<mtr>
<mtd>
<msup>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<mfrac>
<mrow>
<mo>-</mo>
<msqrt>
<mn>3</mn>
</msqrt>
<msup>
<mi>x</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msup>
<mi>y</mi>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
</mrow>
<mn>2</mn>
</mfrac>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,x0”为将所述第三坐标系中声源地的x轴坐标在第一坐标系中换算后声源地位置的x轴坐标;
y0”为所述第三坐标系中声源地的y轴坐标在第一坐标系中换算后声源地位置的y轴坐标;
用于按照下列公式进行声源地计算的装置:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mi>x</mi>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
</mrow>
<mn>3</mn>
</mfrac>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>y</mi>
<mo>=</mo>
<mfrac>
<mrow>
<msup>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msup>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>+</mo>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
</mrow>
<mn>3</mn>
</mfrac>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>z</mi>
<mo>=</mo>
<msup>
<msub>
<mi>z</mi>
<mn>0</mn>
</msub>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<msup>
<msub>
<mi>z</mi>
<mn>0</mn>
</msub>
<mrow>
<mo>&prime;</mo>
<mo>&prime;</mo>
</mrow>
</msup>
<mo>=</mo>
<msub>
<mi>z</mi>
<mn>0</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
其中,x为第一坐标系中的声源地x轴最终坐标;
y为第一坐标系中的声源地y轴最终坐标;
z为第一坐标系中的声源地z轴最终坐标;
用于按照以下公式计算声源地的球坐标值的装置:
其中,为最终输出的所述声源地位置的方位角;
θ为最终输出的声源地位置的俯仰角;
r为最终输出的声源地位置距离原点的距离。
6.如权利要求1至5任一项所述的声源定位导航装置,其特征是:还包括用于声源地位置信息输出的输出模块。
7.如权利要求1至5任一项所述的声源定位导航装置,其特征是:还包括:用于识别声源语义的装置;用于识别语义后向声源进行导航的装置。
8.如权利要求7所述的声源定位导航装置,其特征是,所述用于识别声源语义的装置包括:
用于降噪消回音的装置;
用于连接网络将语音信息转化为文字信息的装置;
用于调用语义解析库对文字信息进行解析的装置;
所述用于识别语义后向声源地进行导航的装置,包括:
包括用于判断是否接收到机器人执行声源定位行走的命令信息装置;
如果不是,则用于回到信息接收的装置;
如果是,则用于计算声源位置的装置;
用于输入电机正反转信号执行运动到声源位置的装置。
9.如权利要求8所述的声源定位导航装置,其特征是:所述用于调用所述语义解析库对文字信息进行解析的装置;包括:
用于收集大量语句,将语句进行分类,然后训练事件分类模型的装置;
用于将语句通过条件随机场分词器进行分词以及词位标注的装置;
用于通过训练语义解析模型,实现对语句语义的理解的装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710452910.7A CN107390176A (zh) | 2017-06-15 | 2017-06-15 | 一种声源定位导航装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710452910.7A CN107390176A (zh) | 2017-06-15 | 2017-06-15 | 一种声源定位导航装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107390176A true CN107390176A (zh) | 2017-11-24 |
Family
ID=60332936
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710452910.7A Pending CN107390176A (zh) | 2017-06-15 | 2017-06-15 | 一种声源定位导航装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107390176A (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108562870A (zh) * | 2018-04-20 | 2018-09-21 | 南京信息工程大学 | 一种声源定位校准方法 |
CN108870650A (zh) * | 2018-07-12 | 2018-11-23 | 四川虹美智能科技有限公司 | 一种空调及一种空调的控制方法 |
CN108919188A (zh) * | 2018-07-25 | 2018-11-30 | 南京信息工程大学 | 一种基于七元十字阵的空间声源定位反演算法 |
CN109019349A (zh) * | 2018-06-19 | 2018-12-18 | 上海振华重工(集团)股份有限公司 | 故障检测方法、检测器、计算机存储介质及起重机 |
CN109254266A (zh) * | 2018-11-07 | 2019-01-22 | 苏州科达科技股份有限公司 | 基于麦克风阵列的声源定位方法、装置及存储介质 |
CN109525929A (zh) * | 2018-10-29 | 2019-03-26 | 中国传媒大学 | 一种录音定位方法及装置 |
CN110339641A (zh) * | 2019-07-31 | 2019-10-18 | 苏州协昌环保科技股份有限公司 | 声波感知智能电磁脉冲阀以及电磁脉冲阀异常检测方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103926563A (zh) * | 2014-04-15 | 2014-07-16 | 哈尔滨工程大学 | 一种超短基线五基元接收基阵及其水声定位方法 |
CN104076331A (zh) * | 2014-06-18 | 2014-10-01 | 南京信息工程大学 | 一种七元麦克风阵列的声源定位方法 |
CN104991573A (zh) * | 2015-06-25 | 2015-10-21 | 北京品创汇通科技有限公司 | 一种基于声源阵列的定位跟踪方法及其装置 |
CN105044676A (zh) * | 2015-09-15 | 2015-11-11 | 北京理工大学 | 一种基于能量的声源定位方法 |
CN105301563A (zh) * | 2015-11-10 | 2016-02-03 | 南京信息工程大学 | 一种基于一致聚焦变换最小二乘法的双声源定位方法 |
CN106723736A (zh) * | 2016-12-23 | 2017-05-31 | 南京医科大学 | 基于相位变换加权广义互相关算法的自主寻人智能拐杖 |
-
2017
- 2017-06-15 CN CN201710452910.7A patent/CN107390176A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103926563A (zh) * | 2014-04-15 | 2014-07-16 | 哈尔滨工程大学 | 一种超短基线五基元接收基阵及其水声定位方法 |
CN104076331A (zh) * | 2014-06-18 | 2014-10-01 | 南京信息工程大学 | 一种七元麦克风阵列的声源定位方法 |
CN104991573A (zh) * | 2015-06-25 | 2015-10-21 | 北京品创汇通科技有限公司 | 一种基于声源阵列的定位跟踪方法及其装置 |
CN105044676A (zh) * | 2015-09-15 | 2015-11-11 | 北京理工大学 | 一种基于能量的声源定位方法 |
CN105301563A (zh) * | 2015-11-10 | 2016-02-03 | 南京信息工程大学 | 一种基于一致聚焦变换最小二乘法的双声源定位方法 |
CN106723736A (zh) * | 2016-12-23 | 2017-05-31 | 南京医科大学 | 基于相位变换加权广义互相关算法的自主寻人智能拐杖 |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108562870A (zh) * | 2018-04-20 | 2018-09-21 | 南京信息工程大学 | 一种声源定位校准方法 |
CN108562870B (zh) * | 2018-04-20 | 2022-03-11 | 南京信息工程大学 | 一种声源定位校准方法 |
CN109019349A (zh) * | 2018-06-19 | 2018-12-18 | 上海振华重工(集团)股份有限公司 | 故障检测方法、检测器、计算机存储介质及起重机 |
CN108870650A (zh) * | 2018-07-12 | 2018-11-23 | 四川虹美智能科技有限公司 | 一种空调及一种空调的控制方法 |
CN108919188A (zh) * | 2018-07-25 | 2018-11-30 | 南京信息工程大学 | 一种基于七元十字阵的空间声源定位反演算法 |
CN108919188B (zh) * | 2018-07-25 | 2022-04-08 | 南京信息工程大学 | 一种基于七元十字阵的空间声源定位反演方法 |
CN109525929A (zh) * | 2018-10-29 | 2019-03-26 | 中国传媒大学 | 一种录音定位方法及装置 |
CN109254266A (zh) * | 2018-11-07 | 2019-01-22 | 苏州科达科技股份有限公司 | 基于麦克风阵列的声源定位方法、装置及存储介质 |
CN110339641A (zh) * | 2019-07-31 | 2019-10-18 | 苏州协昌环保科技股份有限公司 | 声波感知智能电磁脉冲阀以及电磁脉冲阀异常检测方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107390176A (zh) | 一种声源定位导航装置 | |
CN104459625B (zh) | 基于轨道移动双麦克风阵列的声源定位装置及方法 | |
ES2953525T3 (es) | Método y dispositivo de reconocimiento de voz, medio de almacenamiento y acondicionador de aire | |
CN104237849B (zh) | 一种双五元十字阵被动声定位融合方法 | |
CN103308889B (zh) | 复杂环境下被动声源二维doa估计方法 | |
CN101957442B (zh) | 一种声源定位装置 | |
CN106405499A (zh) | 一种机器人定位声源的方法 | |
CN107221336A (zh) | 一种增强目标语音的装置及其方法 | |
CN108802689A (zh) | 基于声源阵列的空间麦克风定位方法 | |
CN106872944A (zh) | 一种基于麦克风阵列的声源定位方法及装置 | |
CN102438189A (zh) | 基于双通路声信号的声源定位方法 | |
CN103856877B (zh) | 一种声控信息检测方法及电子设备 | |
CN105204001A (zh) | 一种声源定位的方法及*** | |
CN103885585A (zh) | 一种基于单人手势和语音信息的机器人人工导航方法 | |
CN109410978A (zh) | 一种语音信号分离方法、装置、电子设备及存储介质 | |
CN107202976A (zh) | 低复杂度的分布式麦克风阵列声源定位*** | |
CN106295395A (zh) | 基于图划分的不确定轨迹隐私保护方法 | |
CN108802690A (zh) | 一种基于麦克风阵列的机器人声源定位***及装置 | |
CN201210187Y (zh) | 一种自主搜寻声源的机器人 | |
CN106863320A (zh) | 一种用于智能机器人的语音交互数据获取方法及装置 | |
CN208444161U (zh) | 机器人声源定位和识别装置 | |
CN107390175A (zh) | 一种以机器人为载体的声源定位导航装置 | |
CN108680901A (zh) | 一种新型的声源方位定位方法 | |
CN105353351A (zh) | 一种基于多信标到达时间差改进型定位方法 | |
CN109254265A (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 | ||
AD01 | Patent right deemed abandoned | ||
AD01 | Patent right deemed abandoned |
Effective date of abandoning: 20190924 |