CN102541080B - 一种具有声源定位功能的移动装置 - Google Patents
一种具有声源定位功能的移动装置 Download PDFInfo
- Publication number
- CN102541080B CN102541080B CN201010586232.1A CN201010586232A CN102541080B CN 102541080 B CN102541080 B CN 102541080B CN 201010586232 A CN201010586232 A CN 201010586232A CN 102541080 B CN102541080 B CN 102541080B
- Authority
- CN
- China
- Prior art keywords
- signal
- microprocessor
- module
- mobile device
- comparer
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明涉及一种具有声源定位功能的移动装置,包括转轮、电机驱动模块、声音接收模块、信号放大模块、峰值保持模块以及微处理器。该声音接收模块接收声音信号,该声音信号经信号放大模块放大后通过峰值保持模块保持,然后再传送至该微处理器,该微处理器根据声音信号判断声源方向,并通过电机驱动模块驱动转轮,进而控制该移动装置向声源方向移动。相对于现有技术,本发明的移动装置可简单快速的判断声源方向。
Description
技术领域
本发明涉及一种移动装置,尤其是涉及一种具有声源定位功能的移动装置。
背景技术
大多数的机器人或者移动装置都具有声源定位系统来根据声源定位。目前,一般的声源定位系统包括声音接收器、信号放大电路、时差测量电路及单片机控制电路。声音接收器接收到声音信号后通过信号放大电路放大并传送至时差测量电路。时差测量电路分辨各路声音信号的时差,单片机控制电路通过时差测量电路的时差信号发出控制信号控制机器人或移动装置移动。但是,采用对各路声音进行时差测量的方式来定位方向需要较复杂的运算方式,对单片机的处理要求较高,对信号处理的时长较长。
发明内容
本发明的目的在于克服现有技术中的缺点与不足,提供一种可简单快速的声源定位的移动装置。
本发明是通过以下的技术方案实现的:一种具有声源定位功能的移动装置,包括转轮、电机驱动模块、声音接收模块、信号放大模块、峰值保持模块以及微处理器。该声音接收模块接收声音信号,该声音信号经信号放大模块放大后通过峰值保持模块保持,然后再传送至该微处理器,该微处理器根据声音信号判断声源方向,并通过电机驱动模块驱动转轮,进而控制该移动装置向声源方向移动。
相对于现有技术,本发明通过峰值保持模块使得采样的声音信号更加精确。同时,本发明的移动装置的声源定位控制方法简单,成本较低,具有广泛应用的前景。
为了能更清晰的理解本发明,以下将结合附图说明阐述本发明的具体实施方式。
附图说明
图1是本发明具有声源定位功能的移动装置的结构框图。
图2是图1所示声音定位系统10的具体电路示意图。
具体实施方式
请参阅图1,其是本发明具有声源定位功能的移动装置的结构框图。本发明的移动装置包括转轮11、电机驱动模块12、声音接收模块13、信号放大模块14、峰值保持模块15以及微处理器16。该声音接收模块13、信号放大模块14、峰值保持模块15和微处理器16组成声音定位系统10。该声音接收模块13分别从该移动装置的前后左右四个方向接收声音信号,该声音信号经信号放大模块14放大后通过峰值保持模块15保持在电路中,然后再传送至微处理器16。微处理器分别对四个方向的声音信号取平均值,判定最大平均值对应的方向为声源方向,从而通过电机驱动模块12驱动转轮11的转动,控制该移动装置向声源方向移动。
请参阅图2,其是声音定位系统10的具体电路示意图。
该声音接收模块13包括4个麦克风132,每个麦克风分别通过一电阻133接入直流电源Vcc。该信号放大模块14包括二IC芯片142,该4个麦克风132分别与由一电容134和一电阻135组成的滤波电路串接后接入IC芯片142的正极引脚,同时该4个麦克风132分别与该电容134和电阻135串接后分别通过电阻136接地。该IC芯片142的负极引脚分别通过一电容143接地。该4个麦克风132的声音信号通过电容134和电阻135滤波后传送至IC芯片142,由该IC芯片142将声音信号放大后分别传送至峰值保持模块15。
该峰值保持模块15包括4个峰值保持电路152,分别用以处理4个麦克风132的声音信号。每一个峰值保持电路152包括一第一比较器154、一第一三极管155、一电容156、一第二比较器157和一第二三极管158。该第一比较器154的信号输入端与IC芯片142的信号输出端连接;该第一比较器154的信号输出端接入第一三极管155的基极;该第一三极管155的发射极与一电阻串接后接入该第二比较器157的信号输入端,同时该第一三极管155的发射极与该电容156串接;该第二比较器157的信号输出端接入该微处理器16的一引脚,同时该第二比较器157的信号输出端和反馈端接回至该第一比较器154的反馈端;该第二三极管158的发射极和集电极分别接入该电容156两端;该第二三极管158的基极通过一电阻接入该微处理器16的一引脚。放大后的声音信号在第一比较器154中与第一三极管155的导通电压相比较,当大于第一三极管155的导通电压时,第一三极管155导通,电容156充电,从而使峰值信号的峰值电压保持在电容156中。电容156中的峰值电压通过第二比较器157传送至微处理器16中。同时,微处理器16可对第二三极管158加一高电平,使得电容156的电量迅速放出,为下次信号采集做准备。
该微处理器16分别接收4个麦克风132采集的声音峰值模拟信号,通过其A/D转换程序将模拟信号转换成为数字信号,并用程序剔除杂音干扰信号。该微处理器16在一个采样周期内对4个麦克风132接收到的声音信号分别求出其平均值,然后对4个平均值做比较,判断平均值最大的那个的麦克风132对应的方向为声源方向。若其中有两个相等的最大平均值,则判断该两个最大平均值对应的麦克风132对应方向角度的平均值为声源方向。
该电机驱动模块12包括至少两个驱动电路122,每个驱动电路122包括一电机124,微处理器16发出的驱动电流通过多个三极管转换成交流电以驱动电机124的正转或反转,从而进一步驱动转轮11的前、后、左、右的运动。
进一步,为了更精确的控制电机124的转速及矫正该移动装置的运动轨迹,该微处理器16采用了如下的PID环闭控制方法。
该PID环闭控制方法的具体算法为:
由于该微处理器16基于采样控制理论,所以将控制模型离散化:以T为采样周期,k为采样序号,用求和的形式代替积分,用增量的形式(求差)代替微分,这样可以将连续的PID计算公式转换成下述离散公式:
该微处理器16根据上述PID算法,将信号峰值采样输入作为当前输入,然后与设定值进行相减得偏差ek,然后再对之进行PID运算产生输出结果Fout,然后让Fout调整电机124的转速,矫正该移动装置的运动轨迹,实现系统的PID控制。该PID控制方法一方面通过比例公式能迅速反应误差,从而减小稳态误差。另一方面只要系统有误差存在,积分控制器就不断地积累,输出控制量,以消除误差。同时可通过微分控制器控制减小超调量,克服振荡,使系统的稳定性提高,同时加快系统的动态响应速度,减小调整时间,从而改善系统的动态性能。
相对于现有技术,本发明通过峰值保持模块使得采样的声音信号更加精确。同时,通过比较声音接收模块中的各路麦克风的信号平均值的强弱来确定声源方向,控制方法简单,成本较低,具有广泛应用的前景。
本发明并不局限于上述实施方式,如果对本发明的各种改动或变形不脱离本发明的精神和范围,倘若这些改动和变形属于本发明的权利要求和等同技术范围之内,则本发明也意图包含这些改动和变形。
Claims (3)
1.一种具有声源定位功能的移动装置,其特征在于:包括转轮、电机驱动模块、声音接收模块、信号放大模块、峰值保持模块以及微处理器,该声音接收模块接收声音信号,该声音信号经信号放大模块放大后通过峰值保持模块保持,然后再传送至该微处理器,该微处理器根据声音信号判断声源方向,并通过电机驱动模块驱动转轮,进而控制该移动装置向声源方向移动;所述峰值保持模块包括4个峰值保持电路;
所述峰值保持电路包括一第一比较器、一第一三极管、一电容、一第二比较器和一第二三极管,经信号放大模块放大后的声音信号传送至该第一比较器的信号输入端,该第一比较器的信号输出端接入第一三极管的基极,该第一三极管的发射极接入该第二比较器的信号输入端,同时该第一三极管的发射极与该电容串接,该第二比较器的信号输出端接入该微处理器的一引脚,该第二比较器的信号输出端和反馈端接回至该第一比较器的反馈端,该第二三极管的发射极和集电极分别接入该电容两端,该第二三极管的基极接入该微处理器的另一引脚;
所述微处理器采用PID闭环控制方法,所述PID闭环控制方法的具体算法为:
所述微处理器将控制模型离散化:以T为采样周期,k为采样序号,用求和的形式代替积分,用增量的形式代替微分,这样可以将连接的PID计算公式转换成下述离散公式:
所述微处理器根据上述PID算法,将信号峰值采样输入作为当前输入,与设定值进行相减得偏差ek,再对之进行PID运算产生输出结果,从而调整电机的转速,矫正移动装置的运动轨迹。
2.根据权利要求1所述的移动装置,其特征在于:该声音接收模块包括4个分别设置在该移动装置的前、后、左、右方向的麦克风,该4个麦克风分别独立接收声音信号,该4个声音信号分别经信号放大模块放大后分别通过独立的峰值保持电路保持,然后再传送至微处理器,该微处理器根据该4个麦克风对应的声音信号的强弱判断声源方向。
3.根据权利要求2所述的移动装置,其特征在于:该微处理器分别接收4个麦克风采集的声音峰值模拟信号,通过未处理器的A/D转换程序将模拟信号转换成为数字信号,并剔除杂音干扰信号,该微处理器在一个采样周期内对各个麦克风接收到的声音信号分别求出其平均值,然后对4个平均值做比较,判断平均值最大的那个麦克风对应的方向为声源方向。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010586232.1A CN102541080B (zh) | 2010-12-11 | 2010-12-11 | 一种具有声源定位功能的移动装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010586232.1A CN102541080B (zh) | 2010-12-11 | 2010-12-11 | 一种具有声源定位功能的移动装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102541080A CN102541080A (zh) | 2012-07-04 |
CN102541080B true CN102541080B (zh) | 2014-04-02 |
Family
ID=46348168
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201010586232.1A Expired - Fee Related CN102541080B (zh) | 2010-12-11 | 2010-12-11 | 一种具有声源定位功能的移动装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102541080B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104486493B (zh) * | 2014-12-10 | 2018-06-19 | 上海斐讯数据通信技术有限公司 | 一种控制手机自动行驶的系统和方法 |
CN104698973B (zh) * | 2015-01-23 | 2017-11-21 | 中国矿业大学 | 一种并联式矿用破碎站的自动对中系统及对中方法 |
CN105388458A (zh) * | 2015-11-19 | 2016-03-09 | 广州杰赛科技股份有限公司 | 一种球状传感器及侦测系统 |
CN105657253B (zh) * | 2015-12-28 | 2019-03-29 | 联想(北京)有限公司 | 一种对焦方法及电子设备 |
CN106324603A (zh) * | 2016-08-10 | 2017-01-11 | 杭州阿优文化创意有限公司 | 室内机器人归位导航方法 |
CN106154882A (zh) * | 2016-08-12 | 2016-11-23 | 柳州鹏达科技有限责任公司 | 遥控器 |
CN106768284B (zh) * | 2016-12-20 | 2021-04-20 | 西安科技大学 | 一种异常声源判断与定位系统及方法 |
CN109561364A (zh) * | 2018-11-15 | 2019-04-02 | 珠海格力电器股份有限公司 | 麦克风的移动方法、装置及设备、存储介质、电子装置 |
CN111857041A (zh) * | 2020-07-30 | 2020-10-30 | 东莞市易联交互信息科技有限责任公司 | 一种智能设备的运动控制方法、装置、设备和存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1808171A (zh) * | 2005-01-19 | 2006-07-26 | 北京北阳电子技术有限公司 | 声源定位装置及其方法及采用该装置的电子设备 |
CN1952684A (zh) * | 2005-10-20 | 2007-04-25 | 松下电器产业株式会社 | 利用麦克风定位声源的方法和装置 |
CN101295015A (zh) * | 2007-04-23 | 2008-10-29 | 财团法人工业技术研究院 | 声源定位系统及声源定位方法 |
CN202126630U (zh) * | 2010-12-11 | 2012-01-25 | 广东骅威玩具工艺股份有限公司 | 一种具有声源定位功能的移动装置 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5983216A (ja) * | 1982-11-04 | 1984-05-14 | Omron Tateisi Electronics Co | 位置決め装置 |
CN1902953A (zh) * | 2003-10-20 | 2007-01-24 | 雷第安斯公司 | 在定位系统中的峰值拾取 |
CN101615432B (zh) * | 2009-07-29 | 2012-04-11 | 杭州士兰微电子股份有限公司 | 峰值采样保持电路,峰值采样保持方法及应用 |
-
2010
- 2010-12-11 CN CN201010586232.1A patent/CN102541080B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1808171A (zh) * | 2005-01-19 | 2006-07-26 | 北京北阳电子技术有限公司 | 声源定位装置及其方法及采用该装置的电子设备 |
CN1952684A (zh) * | 2005-10-20 | 2007-04-25 | 松下电器产业株式会社 | 利用麦克风定位声源的方法和装置 |
CN101295015A (zh) * | 2007-04-23 | 2008-10-29 | 财团法人工业技术研究院 | 声源定位系统及声源定位方法 |
CN202126630U (zh) * | 2010-12-11 | 2012-01-25 | 广东骅威玩具工艺股份有限公司 | 一种具有声源定位功能的移动装置 |
Non-Patent Citations (1)
Title |
---|
JP昭59-83216A 1984.05.14 |
Also Published As
Publication number | Publication date |
---|---|
CN102541080A (zh) | 2012-07-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102541080B (zh) | 一种具有声源定位功能的移动装置 | |
CN104917413B (zh) | 逆变装置及其控制方法 | |
CN202126630U (zh) | 一种具有声源定位功能的移动装置 | |
CN101599724B (zh) | 一种用于太阳能光伏发电系统的mppt控制装置及方法 | |
CN103744465B (zh) | 一种光伏阵列最大功率跟踪方法及装置 | |
CN101639038B (zh) | 一种基于fpga的风电系统最大功率跟踪控制器 | |
CN204482003U (zh) | 一种多功能无线话筒 | |
CN101499755B (zh) | 一种直流电机速度pid控制方法 | |
CN107340776B (zh) | 一种全方位智能跟随行李箱及其控制方法 | |
CN104393852A (zh) | 一种目标信号的自动增益调节系统及方法 | |
CN111969907A (zh) | 音圈电机驱动器及其电流环硬件电路 | |
CN204333898U (zh) | 一种变频空调及其智能功率模块过流保护调整电路 | |
CN103414418B (zh) | 一种直流电机电流pi控制系统的控制方法 | |
CN108988455A (zh) | 一种基于协同控制的超级电容电压均衡方法及其均衡装置 | |
CN104270046B (zh) | 基于转速‑电流二维模糊模型自学习的电机控制方法 | |
CN112906875A (zh) | 一种用于精密气体流量阀的控制系统及方法 | |
CN103645637A (zh) | 单自由度主动磁轴承支持向量机自适应逆控制器构造方法 | |
CN202818206U (zh) | 一种有刷直流电机控制驱动器 | |
CN206020966U (zh) | 一种动态调整采样、控制精度的装置 | |
CN210166508U (zh) | 一种红外线障碍物距离检测电路 | |
CN204408277U (zh) | 功率放大器 | |
CN204190742U (zh) | 一种军用超短波电台自动电平控制电路 | |
CN2700775Y (zh) | 精密太阳自动跟踪系统 | |
CN102620876B (zh) | 一种车辆底盘测功机测功系统 | |
CN205561884U (zh) | 一种传感器老化补偿电路 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20140402 Termination date: 20191211 |
|
CF01 | Termination of patent right due to non-payment of annual fee |