CN103760563A - 近距离避障***用的超声测距定位仪 - Google Patents
近距离避障***用的超声测距定位仪 Download PDFInfo
- Publication number
- CN103760563A CN103760563A CN201410000447.9A CN201410000447A CN103760563A CN 103760563 A CN103760563 A CN 103760563A CN 201410000447 A CN201410000447 A CN 201410000447A CN 103760563 A CN103760563 A CN 103760563A
- Authority
- CN
- China
- Prior art keywords
- pin
- ultrasonic
- singlechip controller
- circuit
- chip
- 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.)
- Granted
Links
Images
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
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
- G01S15/06—Systems determining the position data of a target
- G01S15/42—Simultaneous measurement of distance and other co-ordinates
-
- 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
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/88—Sonar systems specially adapted for specific applications
- G01S15/93—Sonar systems specially adapted for specific applications for anti-collision purposes
- G01S15/931—Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Acoustics & Sound (AREA)
- Computer Networks & Wireless Communication (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Length Measuring Devices Characterised By Use Of Acoustic Means (AREA)
Abstract
近距离避障***用的超声测距定位仪,本发明采用双超声波接收器,使得***可以同时测量出在其运行平面前方近距离内所有物***置的二维坐标,从而可以使近距离避障***用快速的选择出一条最优的避障路线。
Description
技术领域
本发明涉及超声波定位,具体涉及近距离避障***用的超声测距定位仪。
背景技术
在近距离避障***中常使用超声波来测定障碍物与物体间的距离,在常用的超声波避障***中只使用单个发射器和单个接收器,这样只能测量出障碍物与物体间的距离,障碍物与物体之间的角度信息并不能测量出来。对于只具有单个障碍物分布的情况,仅靠距离数据控制器就可以选择出避障路径。但当物体近距离处同时出现多个障碍时,由于没有障碍物具体分布的角度信息,控制器就无法选择出一条正确的避障路径。
发明内容
本发明为解决上述技术问题,提供一种近距离避障***用的超声测距定位仪,本发明采用双超声波接收器,使得***可以同时测量出在其运行平面前方近距离内所有物***置的二维坐标,从而可以使近距离避障***用快速的选择出一条最优的避障路线。
本发明为解决上述技术问题的不足而采用的技术方案是:近距离避障***用的超声测距定位仪,设有单片机控制器,其中S1、C3、R1组成控制器的复位电路,C1、C2、Y1组成控制器外部振荡电路,给控制器提供时钟信号,两个超声波接收器分别与单片机控制器的P3.2脚和P3.3脚连接,超声波发射器与单片机控制器的P3.1脚连接,数字温度传感器的输出端与P3.0脚连接,两个超声波接收器接收到超声波发射器发射出的超声波,并向P3.2脚和P3.3脚处输出一个脉冲信号,单片机控制器处理两个脉冲信号,组成一个二维的探测***;所述的超声波发射器中设有超声波发射电路,超声波发射电路中设有由芯片U3、芯片U4、电容C4、可调电阻R4、电阻R5组成可控振荡电路,芯片U4的T60-T引脚为振荡电路的控制端口,并与单片机控制器的P3.1脚连接,振荡电路的输出信号经电阻R3、三极管Q1组成的放大电路放大后驱动超声波发射器发射超声波。
本发明所述的单片机控制器为AT89S52单片机。
本发明所述的单片机控制器连接有LED显示器。
本发明有益效果为:
1、单个发射器可以保证两个接收器所探测到的所有超声波信号都是在同一时间和同一地点所发射。采用两个超声波接收器,可以组成一个二维的探测***,从而使得***可以测量出前方物体的二维坐标。
2、温度传感器可以测量出环境的温度,根据温度就可以对声速进行补偿,从而提高测量的精度。
3、利用超声波特性、单片机控制、电子计数相结合以此来提高测量精度,实现物体的精准定位、方便使用。
附图说明
图1为本发明的原理框图;
图2为本发明的单片机控制器的电路图;
图3为本发明的超声波接收器的右接收电路图;
图4为本发明的超声波接收器的左接收电路图;
图5为本发明的超声波发射器的电路图;
图6为本发明的数字温度传感器的超声波测温电路图;
图7为本发明的测温原理图;
图8为本发明的LED显示器的超声波显示电路图;
图9为本发明的定位原理图。
具体实施方式
如图1所示,近距离避障***用的超声测距定位仪,超声波发射器与单片机控制器的P3.1脚连接,数字温度传感器的输出端与P3.0脚连接,两个超声波接收器接收到有超声波发射器发射出的超声波,向P3.2脚和P3.3脚处输出一个脉冲信号,单片机控制器处理脉冲信号,组成一个二维的探测***。
图2为控制器的最小工作***,其中S1、C3、R1组成控制器的复位电路,C1、C2、Y1组成控制器外部振荡电路,给控制器提供时钟信号。复位电路和时钟电路保障了控制器的正常运行。采用STC89系列单片机作为控制器,用12864液晶屏显示,超声波驱动信号用单片机的定时器。
本***包含两路超声波接收器,超声波接收器由超声波探头(T60-16RR或T60-16RL)和超声波检测电路(有除探头外的所有元件组成)两部分组成,在超声波探头T60-16RR或T60-16RL接收到有发射器发射出的超声波是会在相应的T60-RL和T60-RR引脚处输出一个脉冲信号,此引脚连接到控制器上,并由控制器处理脉冲信号。双接收器的结构可以组成一个二维的探测***,从而使得***可以测量出前方物体的二维坐标。具体电路如图3图4所示。超声波接收电路采用CX20106A作为控制芯片,其1脚和4脚与声波接收端T60-16RR或者T60-16RL一端连接,一另端接地,其2脚通过电阻R6和电容接地,其3脚通过电容C9接地,其5脚与电阻R7连接后的电阻端,电阻端与8脚一起连接在电源上,其6脚连接电容C11后接地,其7脚通过电阻R8与单片机控制器的T60-RR端连接,电阻R8和T60-RR端之间通过电C10接地,7脚与电阻R8之间的电阻端通过电阻R9接到R7的电阻端。
如图5所示,超声波发射器的超声波发声电路中,U3、U4、C4、R4、R5组成可控振荡电路,U4的T60-T引脚为振荡电路的控制端口,连接控制器后可由控制器控制振荡器是否工作。振荡器的输出经R3、Q1组成的放大电路放大后驱动超声波发射器T60-16T发射超声波。在一次测量中,单个发射器可以保证两个接收器所探测到的所有超声波信号都是在同一时间和同一地点所发射。这测量原理中所要求的。
如图6所示,数字温度传感器可以测量出环境的温度,根据温度就可以对声速进行补偿,从而提高测量的精度。
如图7所示,数字温度传感器采用DS18B20传感器,其中,P为预置,SA为斜率累加器,LTCC为低温系数晶振,C1为计数器1,C为比较,TR为温度寄存器,HTCC为高温系数晶振,C2为计数器2。图中低温度系数品振的振荡频率受温度影响很小,用于产生固定频率的脉冲信号送给计数器1。高温度系数晶振随温度变化其振荡率明显改变,所产生的信号作为计数器2的脉冲输入。计数器1和温度寄存器被预置在-55%所对应的一个基数值。计数器1对低温度系数晶振产生的脉冲信号进行减法计数,当计数器1的预置值减到0时。温度寄存器的值将加1,计数器1的预置将重新被装入,计数器1重新开始对低温度系数晶振产生的脉冲信号进行计数,如此循环直到计数器2计数到0时,停止温度寄存器值的累加,此时温度寄存器中的数值即为所测温度。图2中的斜率累加器用于补偿和修正测温过程中的非线性,其输出用于修正计数器1的预置值。
定位原理如图9所示: 超声波探头T60-16RR和超声波发射器T60-T位于R1位置处,超声波探头T60-16RL位于R2处,R1和R2间的距离为 。控制***通过控制发射器的工作和检测接收器的脉冲信号,可以测量出超射波从R1传播到物体M处再返回到R1处的时间和超射波从R1传播到物体M处再返回到R2处的时间。通过数学推导可以得到:
其中为空气中超射波传输的速度,通过以上的式子就可以将物体M在坐标系中的位置x和y分别求出来。根据三角形的稳定性,上述方法同样适用于多个物体的情况。
LCD显示屏主要用于显示输出定位和测距的结果,显示内容有:测出的物体个数和每个物体的X,Y坐标值。
Claims (3)
1.近距离避障***用的超声测距定位仪,设有单片机控制器,其中S1、C3、R1组成控制器的复位电路,C1、C2、Y1组成控制器外部振荡电路,给控制器提供时钟信号,其特征在于:两个超声波接收器分别与单片机控制器的P3.2脚和P3.3脚连接,超声波发射器与单片机控制器的P3.1脚连接,数字温度传感器的输出端与P3.0脚连接,两个超声波接收器接收到超声波发射器发射出的超声波,向P3.2脚和P3.3脚处输出一个脉冲信号,单片机控制器处理两个脉冲信号,组成一个二维的探测***;所述的超声波发射器中设有超声波发射电路,超声波发射电路中设有由芯片U3、芯片U4、电容C4、可调电阻R4、电阻R5组成可控振荡电路,芯片U4的T60-T引脚为振荡电路的控制端口,并与单片机控制器的P3.1脚连接,振荡电路的输出信号经电阻R3、三极管Q1组成的放大电路放大后驱动超声波发射器发射超声波。
2.如权利要求1所述的近距离避障***用的超声测距定位仪,其特征在于:所述的单片机控制器为AT89S52单片机。
3.如权利要求1所述的近距离避障***用的超声测距定位仪,其特征在于:所述的单片机控制器连接有LED显示器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410000447.9A CN103760563B (zh) | 2014-01-02 | 2014-01-02 | 近距离避障***用的超声测距定位仪 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410000447.9A CN103760563B (zh) | 2014-01-02 | 2014-01-02 | 近距离避障***用的超声测距定位仪 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103760563A true CN103760563A (zh) | 2014-04-30 |
CN103760563B CN103760563B (zh) | 2016-08-24 |
Family
ID=50527830
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410000447.9A Expired - Fee Related CN103760563B (zh) | 2014-01-02 | 2014-01-02 | 近距离避障***用的超声测距定位仪 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103760563B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104569992A (zh) * | 2014-12-02 | 2015-04-29 | 科世达(上海)管理有限公司 | 汽车浅水行驶避障方法、***及装置 |
CN106483526A (zh) * | 2016-12-03 | 2017-03-08 | 杭州立方控股股份有限公司 | 一种无盲区超声波测距探头及测距方法 |
CN110749888A (zh) * | 2019-12-20 | 2020-02-04 | 广州赛特智能科技有限公司 | 一种基于超声波测距***的测距方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN2344752Y (zh) * | 1998-11-10 | 1999-10-20 | 华中理工大学 | 超声波多维检测与定位装置 |
CN101303410A (zh) * | 2007-05-08 | 2008-11-12 | 李世雄 | 单方发射暨多方接收的障碍物检测方法及其装置 |
CN101723187A (zh) * | 2008-10-23 | 2010-06-09 | 宝山钢铁股份有限公司 | 一种港口货轮卸船机的自动防撞***及方法 |
CN201837720U (zh) * | 2010-10-26 | 2011-05-18 | 林禹鹏 | 基于单片机控制的超声波测距装置 |
CN102844675A (zh) * | 2010-04-20 | 2012-12-26 | 罗伯特·博世有限公司 | 用于确定目标物体的距离和方向的装置 |
JP2013036837A (ja) * | 2011-08-08 | 2013-02-21 | Daihatsu Motor Co Ltd | 車両用物体形状認識装置 |
CN203673068U (zh) * | 2014-01-02 | 2014-06-25 | 河南科技大学 | 近距离避障***用的超声测距定位仪 |
-
2014
- 2014-01-02 CN CN201410000447.9A patent/CN103760563B/zh not_active Expired - Fee Related
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN2344752Y (zh) * | 1998-11-10 | 1999-10-20 | 华中理工大学 | 超声波多维检测与定位装置 |
CN101303410A (zh) * | 2007-05-08 | 2008-11-12 | 李世雄 | 单方发射暨多方接收的障碍物检测方法及其装置 |
CN101723187A (zh) * | 2008-10-23 | 2010-06-09 | 宝山钢铁股份有限公司 | 一种港口货轮卸船机的自动防撞***及方法 |
CN102844675A (zh) * | 2010-04-20 | 2012-12-26 | 罗伯特·博世有限公司 | 用于确定目标物体的距离和方向的装置 |
CN201837720U (zh) * | 2010-10-26 | 2011-05-18 | 林禹鹏 | 基于单片机控制的超声波测距装置 |
JP2013036837A (ja) * | 2011-08-08 | 2013-02-21 | Daihatsu Motor Co Ltd | 車両用物体形状認識装置 |
CN203673068U (zh) * | 2014-01-02 | 2014-06-25 | 河南科技大学 | 近距离避障***用的超声测距定位仪 |
Non-Patent Citations (2)
Title |
---|
王振江等: "基于AT89C51的高精度超声波测距***", 《传感器世界》, 31 January 2010 (2010-01-31), pages 20 - 23 * |
琚晓涛等: "基于LTC1609的高精度超声测距***设计", 《自动化与仪表》, 30 November 2010 (2010-11-30), pages 14 - 17 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104569992A (zh) * | 2014-12-02 | 2015-04-29 | 科世达(上海)管理有限公司 | 汽车浅水行驶避障方法、***及装置 |
CN106483526A (zh) * | 2016-12-03 | 2017-03-08 | 杭州立方控股股份有限公司 | 一种无盲区超声波测距探头及测距方法 |
CN106483526B (zh) * | 2016-12-03 | 2023-09-19 | 杭州立方控股股份有限公司 | 一种无盲区超声波测距探头及测距方法 |
CN110749888A (zh) * | 2019-12-20 | 2020-02-04 | 广州赛特智能科技有限公司 | 一种基于超声波测距***的测距方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103760563B (zh) | 2016-08-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN203241431U (zh) | 一种舰载超声波测风仪 | |
CN104459705A (zh) | 一种具有温度补偿的超声波测距*** | |
CN202025082U (zh) | 一种高精度超声波测距装置 | |
CN104198016A (zh) | 超声波液位计及超声波液位检测方法 | |
CN103760563A (zh) | 近距离避障***用的超声测距定位仪 | |
CN101881832A (zh) | 利用超声波测量物***置的方法及装置 | |
CN103969625A (zh) | 一种无线定位方法 | |
CN104101879A (zh) | 基于超声波的车辆空间定位方法及*** | |
CN203673068U (zh) | 近距离避障***用的超声测距定位仪 | |
CN104459704A (zh) | 一种结合环境温度的距离测量方法 | |
KR101259634B1 (ko) | 풍향 및 풍속 측정 장치 그리고 측정 방법 | |
CN205193278U (zh) | 一种基于超声波传感器的自动测距装置 | |
CN104897219A (zh) | 高精度低功耗超声流量计 | |
CN105182355A (zh) | 一种具有温度补偿的红外光自动调焦显微镜 | |
Mohamed et al. | Real time wireless flood monitoring system using ultrasonic waves | |
CN108169735A (zh) | 一种对射式的测距*** | |
CN103884446A (zh) | 北斗授时的石英晶体温度计 | |
CN103792021A (zh) | Gps授时的石英晶体温度计 | |
CN207963755U (zh) | 一种手持gps土地测量用测距仪 | |
CN203732109U (zh) | 基于Cortex M3内核处理器的气体流量测量电路 | |
CN105738651A (zh) | 一种带温度补偿的超声波测风速装置 | |
CN205843765U (zh) | 一种基于传感器的液位测量*** | |
CN103983947A (zh) | 一种基于超声波的无线定位***及方法 | |
CN201611242U (zh) | 一种射击瞄准器 | |
CN108036851A (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 | ||
CB03 | Change of inventor or designer information |
Inventor after: Tang Zhengxin Inventor after: Lv Yu Inventor after: Liu Zhe Inventor after: Su Xiangying Inventor after: Wang Hui Inventor before: Tang Zhengxin Inventor before: Liu Zhe |
|
COR | Change of bibliographic data | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160824 Termination date: 20170102 |