CN100580597C - 基于超声波源的二维定位控制*** - Google Patents
基于超声波源的二维定位控制*** Download PDFInfo
- Publication number
- CN100580597C CN100580597C CN200810059313A CN200810059313A CN100580597C CN 100580597 C CN100580597 C CN 100580597C CN 200810059313 A CN200810059313 A CN 200810059313A CN 200810059313 A CN200810059313 A CN 200810059313A CN 100580597 C CN100580597 C CN 100580597C
- Authority
- CN
- China
- Prior art keywords
- ultrasound wave
- ultrasonic
- base stations
- axis
- distance
- 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
- 238000002604 ultrasonography Methods 0.000 title claims description 57
- 230000003068 static effect Effects 0.000 claims abstract description 14
- 238000005516 engineering process Methods 0.000 description 4
- 241000209094 Oryza Species 0.000 description 2
- 235000007164 Oryza sativa Nutrition 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 239000002360 explosive Substances 0.000 description 2
- 235000009566 rice Nutrition 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 230000000644 propagated effect Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种基于超声波源的二维定位控制***,包括两个静止超声波基站、安装在受控二维平面作业的机械上的超声波收发器和定位控制器,超声波基站在收到超声波信号后转发超声波信号,定位控制器包括距离计算模块,用于计算当前点与两个超声波基站的距离L1和L2,目标点与两个超声波基站的距离L3和L4;数据存储模块,用于存储两个静止超声波基站之间的距离L、L1和L2、L3和L4;定位移动控制模块,用于当机械从当前点移动到目标点时,通过X轴和Y轴移动来实现,将所述X轴和Y轴移动距离控制指令输出到机械的X轴受控电机和Y轴受控电机。本发明提供一种定位精度高、实用性强的基于超声波源的二维定位控制***。
Description
技术领域
本发明涉及一种二维定位控制***。
背景技术
比较常见的无人农业作机或机器人是通过无线电磁波通信技术实现数据命令和视频图像信号的远程通信和控制,存在的问题有两个:一是现场***装置往往是受到无线电磁波远程操作的,机器人的无线电磁操作将极大的可能影响***装置,甚至引起误引爆;二是电磁波技术在定位上存在一定的困难,像无人农业作机的自动运作往往需要比较规则路经的场地运作,对自身的定位要求比较高。
发明内容
为了克服已有的二维定位***的定位精度低的不足,本发明提供一种定位精度高、实用性强的基于超声波源的二维定位控制***。
本发明解决其技术问题所采用的技术方案是:
一种基于超声波源的二维定位控制***,包括两个静止超声波基站、安装在受控二维平面作业的机械上的超声波收发器和定位控制器,所述超声波基站在收到超声波信号后转发超声波信号,所述定位控制器包括:距离计算模块,用于依据超声波收发器发出超声波信号的时间和接收到静止超声波基站转发的超声波时间,依据超声波的传播速度,计算得到当前点与两个超声波基站的距离L1和L2,目标点与两个超声波基站的距离L3和L4;数据存储模块,用于存储两个静止超声波基站之间的距离L、当前点与两个超声波基站的距离L1和L2、以及目标点与两个超声波基站的距离L3和L4;
定位移动控制模块,用于当机械从当前点移动到目标点时,通过X轴和Y轴移动来实现,其中:
将所述X轴和Y轴移动距离控制指令输出到机械的X轴受控电机和Y轴受控电机。
本发明的技术构思为:超声波技术的引入正好解决了现有技术中存在的问题,超声波属于一种机械波,当超声波在空间传播时,如果遇到障碍物就能反射,传播的速度和声波类似,如果记录带调制的超声波发出和接收的时间差,就能比较简单的测量到和障碍物的距离。
如图1,构建了两个静止的超声波基站JZ1、JZ2,每个基站可以同时收发超声波信号,而且发出的超声波信号是带编码调制的,可以被移动超声波源有辨别的接收。可移动超声波源是架构在可移动机械M上的,该移动机械M可以是步进电机驱动的机器人或农业作机,可移动超声波源也可以同时收发超声波信号,发出的超声波信号也是带编码调制的。在该二维平面内,基站和可移动超声波源发出的带编码调制超声波信号足够的强,即采用大功率超声波发生器,可移动超声波源发出的超声波信号同时可以被两个基站接收。如图2,当可移动超声波源在A点时,可以通过式1和式2得到:
A点的坐标(X1,Y1),其中:
L是两个静止基站间的距离;L1是移动超声波源和第一静止基站JZ1的距离;L2是移动超声波源和第二静止基站JZ2的距离;α是移动超声波源和第一静止基站JZ1的夹角;
可移动超声波源在B点时,可以通过式3和式4得到:
B点的坐标(X2,Y2),其中:
L是两个静止基站间的距离;L3是移动超声波源和第一静止基站JZ1的距离;L4是移动超声波源和第二静止基站JZ2的距离;β是移动超声波源和第一静止基站JZ1的夹角;
当移动超声波源从A点移动到B点时,可以通过X轴和Y轴分别移动实现,从点A(X1,Y1)移动到点B(X2,Y2)在X轴上需要移动:
从点A(X1,Y1)移动到点B(X2,Y2)在Y轴上需要移动:
通过以上的方法可实现可移动超声波源在二维平面内的自由移动和定位。
本发明的有益效果主要表现在:定位精度高、实用性强。
附图说明
图1是移动超声波源和静止超声波基站双向通信的二维图。
图2是可移动超声波源在二维平面内的定位图。
具体实施方式
下面结合附图对本发明作进一步描述。
参照图1和图2,一种基于超声波源的二维定位控制***,包括两个静止超声波基站JZ1、JZ2、安装在受控二维平面作业的机械M上的超声波收发器和定位控制器,所述超声波基站在收到超声波信号后转发超声波信号,所述定位控制器包括:距离计算模块,用于依据超声波收发器发出超声波信号的时间和接收到静止超声波基站转发的超声波时间,依据超声波的传播速度,计算得到当前点A与两个超声波基站的距离L1和L2,目标点B与两个超声波基站的距离L3和L4;数据存储模块,用于存储两个静止超声波基站之间的距离L、当前点与两个超声波基站的距离L1和L2、以及目标点与两个超声波基站的距离L3和L4;
定位移动控制模块,用于当机械M从当前点A移动到目标点B时,通过X轴和Y轴移动来实现,其中:
将所述X轴和Y轴移动距离控制指令输出到机械的X轴受控电机和Y轴受控电机。
以可移动小型农业割稻机为例,先在稻田边确定两个静止基站点JZ1、JZ2,安装好大功率静止超声波发生器后并测得两基站点的距离,在移动小型农业作机上安装移动超声波发生器。假设通过程序设定,需要农业作机在起点(3,0)处垂直X轴沿Y轴方向前进到点(3,10)处停止,可移动超声波源只要实时的测量和两个静止基站的距离,通过内部的定位移动控制模块计算,得到X轴和Y轴上需要移动的距离,指挥电机转动就可以顺利到达目的地。
Claims (1)
1、一种基于超声波源的二维定位控制***,其特征在于:包括两个静止超声波基站、安装在受控二维平面作业的机械上的超声波收发器和定位控制器,所述超声波基站在收到超声波信号后转发超声波信号,所述定位控制器包括:
距离计算模块,用于依据超声波收发器发出超声波信号的时间和接收到静止超声波基站转发的超声波时间,依据超声波的传播速度,计算得到当前点与两个超声波基站的距离L1和L2,目标点与两个超声波基站的距离L3和L4;
数据存储模块,用于存储两个静止超声波基站之间的距离L、当前点与两个超声波基站的距离L1和L2、以及目标点与两个超声波基站的距离L3和L4;
定位移动控制模块,用于当机械从当前点移动到目标点时,通过X轴和Y轴移动来实现,其中:
将所述X轴和Y轴移动距离控制指令输出到机械的X轴受控电机和Y轴受控电机。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200810059313A CN100580597C (zh) | 2008-01-18 | 2008-01-18 | 基于超声波源的二维定位控制*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200810059313A CN100580597C (zh) | 2008-01-18 | 2008-01-18 | 基于超声波源的二维定位控制*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101226405A CN101226405A (zh) | 2008-07-23 |
CN100580597C true CN100580597C (zh) | 2010-01-13 |
Family
ID=39858440
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200810059313A Expired - Fee Related CN100580597C (zh) | 2008-01-18 | 2008-01-18 | 基于超声波源的二维定位控制*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN100580597C (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101881832B (zh) * | 2010-06-30 | 2012-07-04 | 南京信息工程大学 | 利用超声波测量物***置的方法及装置 |
CN102800325A (zh) * | 2012-08-31 | 2012-11-28 | 厦门大学 | 一种超声波辅助麦克风阵列语音增强装置 |
CN104569916B (zh) * | 2015-01-30 | 2017-10-20 | 中国联合网络通信集团有限公司 | 一种室内定位方法、定位装置和客户端 |
CN104897088B (zh) * | 2015-06-05 | 2017-11-17 | 重庆交通大学 | 一种大型结构相对位移变化量的超声波测量方法 |
CN107466371B (zh) * | 2016-07-21 | 2021-08-13 | 深圳前海达闼云端智能科技有限公司 | 目标跟踪装置及***、机器人 |
CN113909207A (zh) * | 2021-09-01 | 2022-01-11 | 苏州鑫格雅电子科技有限公司 | 一种玻璃制造用超声波清洗方法与*** |
-
2008
- 2008-01-18 CN CN200810059313A patent/CN100580597C/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN101226405A (zh) | 2008-07-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100580597C (zh) | 基于超声波源的二维定位控制*** | |
CN100486355C (zh) | 无线通信***中实现移动台定位的方法及装置 | |
CN103956074A (zh) | 基于位置服务的停车场自动指引***及实现方法 | |
CN103809174B (zh) | 自动跟随方法及装置 | |
CN104853402A (zh) | 无线接入服务方法和设备 | |
CN110109129A (zh) | 一种agv室内仓储物流导航定位***和定位方法 | |
CN102868029B (zh) | 一种用于动中通散射的天线对准方法 | |
CN201266322Y (zh) | 超声波目标定位与跟踪装置 | |
CN201659565U (zh) | 一种室内移动机器人导航定位*** | |
CN205427184U (zh) | 基于数据融合的组网导航雷达目标跟踪*** | |
CN101719771B (zh) | 频偏处理方法和***以及直放站 | |
CN104729538A (zh) | 基于激光扫描的采煤机定位定姿***的校准方法及装置 | |
CN107770862A (zh) | 基于车地通信的列车定位***及基于该***的定位方法 | |
CN102436260A (zh) | 一种室内自主定位与定向的二维导航*** | |
CN103193158B (zh) | 轮轨式起重机位置检测*** | |
CN101707805A (zh) | 移动终端多基站频移综合定位方法 | |
CN111273273B (zh) | 无线通信引导的双向主动测距定位方法及*** | |
CN111830462B (zh) | 一种应用于排水深隧工程水下机器人定位的方法及装置 | |
CN210072416U (zh) | 一种智能跟随运动装置 | |
CN102495410B (zh) | 一种特种车辆考场定位***及方法 | |
KR20150035303A (ko) | 철도 차량의 운영 패턴에 따른 빔 포밍 장치 및 그 방법 | |
CN204479086U (zh) | 基于激光扫描的采煤机定位定姿***的校准装置 | |
KR100979943B1 (ko) | 차량용 레이더 안테나의 각도를 조절하는 장치 및 방법 | |
KR101403399B1 (ko) | 이동 통신 안테나 간 자동지향 및 정렬 안정화 장치 및 방법 | |
RU2010116346A (ru) | Устройство и способ контроля устройства для технического обслуживания |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20100113 Termination date: 20130118 |