CN107830847A - 红外超声平面定位测量装置及定位方法 - Google Patents
红外超声平面定位测量装置及定位方法 Download PDFInfo
- Publication number
- CN107830847A CN107830847A CN201711015581.6A CN201711015581A CN107830847A CN 107830847 A CN107830847 A CN 107830847A CN 201711015581 A CN201711015581 A CN 201711015581A CN 107830847 A CN107830847 A CN 107830847A
- Authority
- CN
- China
- Prior art keywords
- ultrasonic
- pen
- generator
- infrared
- positioning
- 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
- 238000005259 measurement Methods 0.000 title claims abstract description 18
- 238000000034 method Methods 0.000 title claims abstract description 9
- 230000004807 localization Effects 0.000 title abstract 3
- 230000005540 biological transmission Effects 0.000 claims abstract description 18
- 239000013078 crystal Substances 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 5
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C15/00—Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明公开了一种红外超声平面定位测量装置,包括定位笔以及测量杆;所述定位笔设有与笔尖共线的超声波发生波器C1以及超声波发生器C2,还设有红外线发生器H0;测量杆包括单片机、红外线接收器Hs0以及位于测量杆两端的超声波接收器Cs1、Cs2;单片机为超声波接收器Cs1、Cs2分别提供计数器J1、J2。还提供了一种定位方法:定位笔向测量杆发送红外信号以及超声信号,在红外线接收器Hs0接收到红外信号时,计数器J1、J2开始计数;在超声波接收器Cs1接收到超声信号时,计数器J1停止计数;在超声波接收器Cs2接收到超声信号时,计数器J2停止计数;利用计数器采集超声波传输时间,进而利用定位算法进行定位。本发明能够大大提高定位精度,扩大超声定位的测量范围。
Description
技术领域
本发明属于平面测绘技术领域,具体涉及一种利用红外及超声信号进行平面定位的装置以及利用该装置进行的定位方法。
背景技术
目前,在对各种平面中的点进行定位时一般采用三点定位算法,需要已知三点的位置坐标,并需要测量未知点到三点的距离,然后分别以三个已知点为圆心并以已知点到未知点的距离为半径作三个圆,三个圆的交点就是测量点的坐标。然而,这是一个理想情况,实际由于测量精度的限制,实际上他们通常交不到一个点上,交出来的是一块面积区域。
现有技术中一般采用超声波对定位所需的距离进行测量,超声波传播的时间乘以速度就是超声波传播距离,其关键在于对超声波传播的时间进行测量,然而现有技术对超声波传播时间的测量只是单纯的利用时钟上的时间求发送时刻和接收时刻的时间差,存在不小的误差,再加上超声波的传播速度达到了340m/s,即使时间误差只有1s,定位距离也存在340m的误差,定位精度低。这样,就导致了利用现有技术中的超声波定位装置不能适用于小区域的定位。
发明内容
针对上述现有技术的不足,本发明提供一种红外超声平面定位测量装置,解决现有技术中超声定位精度较低的技术问题,用于进行平面定位测量能够大大提高定位精度,扩大超声定位的测量范围。
为解决上述技术问题,本发明的技术方案如下:一种红外超声平面定位测量装置,包括定位笔以及测量杆;所述定位笔包括笔杆、电源以及信号控制电路,所述笔杆内靠近笔尾与笔尖两端分别设有与笔尖共线的超声波发生波器C1以及超声波发生器C2,笔杆上还设有红外线发生器H0;所述信号控制电路能够产生分别驱动超声波发生波器C1、C2的脉冲信号t1、t2,两个脉冲驱动信号的周期均为T0;脉冲信号t1与脉冲信号t2的时间间隔为T1,0<T1<0.5T0;脉冲信号t1能够同时驱动超声波发生波器C1与红外线发生器H0工作;脉冲信号t2能够同时驱动超声波发生C2与红外线发生器H0工作;
所述测量杆包括单片机、红外线接收器Hs0以及位于测量杆两端的超声波接收器Cs1、Cs2;所述单片机为超声波接收器Cs1、Cs2分别提供计数器J1、J2;在红外线接收器Hs0接收到红外信号时,计数器J1、J2开始计数;在超声波接收器Cs1接收到超声信号时,计数器J1停止计数;在超声波接收器Cs2接收到超声信号时,计数器J2停止计数。
优选的,所述红外线发生器H0设置在笔杆内靠近超声波发生器C2的位置,红外线发生器H0与笔尖共线;电源设置在笔杆中部;信号控制电路设置在靠近超声波发生器C1的位置。
优选的,单片机的晶振为18MHZ,经1/2分频后,为计数器J1、J2提供均为9MHZ的计数频率。
本发明还提供了一种采用本发明的红外超声平面定位测量装置的定位方法,包括以下步骤:
步骤s1:将测量杆水平放置在平面上,将定位笔的笔尖点触到平面的待测点上;
步骤s2:开启测量杆以及定位笔;两个脉冲信号t1、t2的其中之一驱动定位笔的红外线发生器H0向测量杆发送红外信号,同时驱动超声波发生波器C1、C2中的一个向测量杆发送超声信号;时间间隔T1后,另一脉冲信号驱动定位笔的红外线发生器H0向测量杆发送红外信号,同时驱动超声波发生波器C1、C2中的另一个向测量杆发送超声信号;
步骤s3:测量杆接收到红外信号,计数器J1、J2同时开始计数;之后,测量杆的超声波接收器Cs1、Cs2先后接收到超声信号,计数器J1、J2先后停止计数;
步骤s4:单片机根据识别规则识别当前发送超声信号的超声波发生器,识别规则为:若当前超声信号与上一次超声信号的时差大于0.5T0,则当前超声波发生器为C1;若当前超声信号与上一次超声信号的时差小于0.5T0,则当前超声波发生器为C2;
步骤s5:计算超声波传输时间,按如下规则:
当超声波接收器Cs1、Cs2当前接收到的是超声波发生器C1发送的超声波,则超声波发生器C1到超声波接收器Cs1、Cs2的传输时间分别为T1CS1、T1CS2,按如下公式:
T1CS1=n1cs1×tjs0;其中,n1cs1为计数器J1的计数,tjs0为计数器J1的计数周期;
T1CS2=n1cs2×tjs0;其中,n1cs2为计数器J2的计数,tjs0为计数器J2的计数周期;
当超声波接收器Cs1、Cs2当前接收到的是超声波发生器C2发送的超声波,则超声波发生器C2到超声波接收器Cs1、Cs2的传输时间分别为T2CS1、T2CS2,按如下公式:
T2CS1=n2cs1×tjs0;其中,n2cs1为计数器J1的计数,tjs0为计数器J1的计数周期;
T1CS2=n2cs2×tjs0;其中,n2cs2为计数器J2的计数,tjs0为计数器J2的计数周期;
步骤s6:计算超声波发生器到超声波接收器的距离,设超声波在空气中的传播速度为按如下公式:
超声波发生器C1到超声波接收器Cs1为
超声波发生器C1到超声波接收器Cs2为
超声波发生器C2到超声波接收器Cs1为
超声波发生器C2到超声波接收器Cs2为
步骤s7:分别计算定位笔笔尖到超声波接收器Cs1、Cs2之间的距离LOCS1、LOCS2,按如下公式:
其中,L20为笔尖到超声波发生器C2的距离,L12为超声波发生器C1到C1的距离;
步骤s8:以超声波接收器Cs1、Cs2以及定位笔笔尖三点所确定的平面建立平面直角坐标系r:以超声波接收器Cs1为原点O′,以超声波接收器Cs1、Cs2之间的连线为y轴,以垂直于y轴的直线为x轴;计算定位笔笔尖与超声波接收器Cs1的连线与y轴的夹角Φ0,按如下公式:
步骤s9:计算定位笔笔尖在坐标系r中的坐标(x,y),按如下公式:
以定位笔笔尖的坐标作为平面内待测点的坐标,从而实现对待测点的定位。
优选的,当坐标系r与所测平面的标准坐标系R不重合时,步骤s9还对定位笔笔尖坐标(x,y)进行校正,其中,标准坐标系R的原点为O,横坐标轴为X,纵坐标轴为Y,按如下步骤校正定位笔笔尖坐标(x,y):
步骤s901:原点O在坐标系r中的坐标为(x0,y0),选取横坐标轴X上任意一点(xm,ym),计算x轴与X轴之间的夹角τ:
步骤s902:计算定位笔笔尖坐标(x,y)在标准坐标系R中的坐标(X,Y),按如下公式:
以校正后的定位笔笔尖坐标(X,Y)作为平面内待测点的坐标,从而实现对待测点的定位。
与现有技术相比,本发明具有以下有益效果:
1、本发明在超声波测距的基础上结合红外线控制技术,精确采集超声波传播时间,使得超声波测距精度更高,是提高定位精度的有利保障。
2、本发明利用了红外线传播速度远大于超声波的特性,实现了对计数器启闭的控制,利用计数器来采集超声波传播时间,由于计数器能够具有较高的计数频率,合理配置计数器频率参数,能够大大提高测距精度。本发明采用9MHz的计数频率,计数周期则为0.11μs,距离精度可达0.04mm。
3、本发明的红外超声平面定位测量装置采用标准器件制造,具有结构简单、体积小重量轻、成本低廉、可靠性好、精度高以及稳定性高的优点。
4、本发明的装置测量范围广,在脉冲信号周期T0为50ms,时间间隔T1为20ms,无干扰情况下,超声信号20ms可以传播距离为6800mm;考虑信号盲区和信号强度问题,本发明测量范围可达5~6000mm。
附图说明
图1是定位笔的结构示意图;
图2是测量杆的结构示意图;
图3是定位笔笔尖位置测量示意图;
图4是利用计数器计量超声波传输时间的原理图;
图5是计算夹角Φ0的原理图;
图6是平面直角坐标系转换示意图。
具体实施方式
如图1至图2所示,一种红外超声平面定位测量装置,包括定位笔以及测量杆;所述定位笔包括笔杆、电源2以及信号控制电路3,所述笔杆内靠近笔尾与笔尖1两端分别设有与笔尖共线的超声波发生波器C1以及超声波发生器C2,笔杆上还设有红外线发生器H0;所述信号控制电路3能够产生分别驱动超声波发生波器C1、C2的脉冲信号t1、t2,两个脉冲驱动信号的周期均为T0;脉冲信号t1与脉冲信号t2的时间间隔为T1,0<T1<0.5T0;脉冲信号t1能够同时驱动超声波发生波器C1与红外线发生器H0工作;脉冲信号t2能够同时驱动超声波发生C2与红外线发生器H0工作;
所述测量杆包括单片机4、红外线接收器Hs0以及位于测量杆两端的超声波接收器Cs1、Cs2;所述单片机4为超声波接收器Cs1、Cs2分别提供计数器J1、J2;在红外线接收器Hs0接收到红外信号时,计数器J1、J2开始计数;在超声波接收器Cs1接收到超声信号时,计数器J1停止计数;在超声波接收器Cs2接收到超声信号时,计数器J2停止计数。
在利用本具体实施方式中的红外超声平面定位测量装置采集到超声波传输时间后,再利用定位算法计算出定位笔笔尖1的坐标即可实现定位。定位算法可以以软件程序写入测量杆的单片机4中,也可以另外设置上位机,将红外超声平面定位测量装置采集到的相关数据,如超声波发生器识别信号、超声波传输时间、超声波发生器与超声波接收器之间的距离,通过数据通信模块传输到上位机中,再由上位机运行定位算法。定位算法可以采用但不限于本发明中步骤s4到步骤s9的定位算法。
本具体实施方式中的,红外超声平面定位测量装置中的定位笔能够同时发出超声波与红外线,由于红外线传播速度远大于超声波,红外线会比超声波先到达测量杆,测量杆先接收到红外线以启动计数器,计数器开始计数,之后超声波到达测量杆,计数器便会停止计数,统计计数器的计数,然后乘以计数周期便能获得超声波传播时间。另外,由于两个超声波接收器距离超声波发生器的距离不相同,因此计数器J1、J2会先后接收到超声波。
本具体实施方式中,所述红外线发生器H0设置在笔杆内靠近超声波发生器C2的位置,红外线发生器H0与笔尖共线;电源2设置在笔杆中部;信号控制电路3设置在靠近超声波发生器C1的位置。这样,各电气元件在笔杆中布局更加合理,定位杆配重平衡。
本具体实施方式中,单片机的晶振为18MHZ,经1/2分频后,为计数器J1、J2提供均为9MHZ的计数频率。这样,计数器的计数周期则为0.11μs,距离精度可达0.04mm。
本具体实施方式中,脉冲信号的周期T0为50ms,脉冲信号t1、t2的时间间隔T1为20ms。这样,测量范围广,在脉冲信号周期T0为50ms,时间间隔T1为20ms,无干扰情况下,超声信号20ms可以传播距离为6800mm;考虑信号盲区和信号强度问题,本发明测量范围可达5~6000mm。
如图3至图6所示,采用本具体实施方式中的红外超声平面定位测量装置的定位方法,包括以下步骤:
步骤s1:将测量杆水平放置在平面上,将定位笔的笔尖1点触到平面的待测点O上;
步骤s2:开启测量杆以及定位笔;两个脉冲信号t1、t2的其中之一驱动定位笔的红外线发生器H0向测量杆发送红外信号,同时驱动超声波发生波器C1、C2中的一个向测量杆发送超声信号;时间间隔T1后,另一脉冲信号驱动定位笔的红外线发生器H0向测量杆发送红外信号,同时驱动超声波发生波器C1、C2中的另一个向测量杆发送超声信号;
步骤s3:测量杆接收到红外信号,计数器J1、J2同时开始计数;之后,测量杆的超声波接收器Cs1、Cs2先后接收到超声信号,计数器J1、J2先后停止计数;
步骤s4:单片机根据识别规则识别当前发送超声信号的超声波发生器,识别规则为:若当前超声信号与上一次超声信号的时差大于0.5T0,则当前超声波发生器为C1;若当前超声信号与上一次超声信号的时差小于0.5T0,则当前超声波发生器为C2;
步骤s5:计算超声波传输时间,按如下规则:
当超声波接收器Cs1、Cs2当前接收到的是超声波发生器C1发送的超声波,则超声波发生器C1到超声波接收器Cs1、Cs2的传输时间分别为T1CS1、T1CS2,按如下公式:
T1CS1=n1cs1×tjs0;其中,n1cs1为计数器J1的计数,tjs0为计数器J1的计数周期;
T1CS2=n1cs2×tjs0;其中,n1cs2为计数器J2的计数,tjs0为计数器J2的计数周期;
当超声波接收器Cs1、Cs2当前接收到的是超声波发生器C2发送的超声波,则超声波发生器C2到超声波接收器Cs1、Cs2的传输时间分别为T2CS1、T2CS2,按如下公式:
T2CS1=n2cs1×tjs0;其中,n2cs1为计数器J1的计数,tjs0为计数器J1的计数周期;
T1CS2=n2cs2×tjs0;其中,n2cs2为计数器J2的计数,tjs0为计数器J2的计数周期;
步骤s6:计算超声波发生器到超声波接收器的距离,设超声波在空气中的传播速度为按如下公式:
超声波发生器C1到超声波接收器Cs1为
超声波发生器C1到超声波接收器Cs2为
超声波发生器C2到超声波接收器Cs1为
超声波发生器C2到超声波接收器Cs2为
步骤s7:分别计算定位笔笔尖到超声波接收器Cs1、Cs2之间的距离LOCS1、LOCS2,按如下公式:
其中,L20为笔尖到超声波发生器C2的距离,L12为超声波发生器C1到C1的距离;
步骤s8:以超声波接收器Cs1、Cs2以及定位笔笔尖三点所确定的平面建立平面直角坐标系r:以超声波接收器Cs1为原点o,以超声波接收器Cs1、Cs2之间的连线为y轴,以垂直于y轴的直线为x轴;计算定位笔笔尖与超声波接收器Cs1的连线与y轴的夹角Φ0,按如下公式:
步骤s9:计算定位笔笔尖在坐标系r中的坐标(x,y),按如下公式:
以定位笔笔尖的坐标作为平面内待测点的坐标,从而实现对待测点的定位。
本具体实施方式中,当坐标系r与所测平面的标准坐标系R不重合时,步骤s9还对定位笔笔尖坐标(x,y)进行校正,其中,标准坐标系R的原点为o′,横坐标轴为X,纵坐标轴为Y,按如下步骤校正定位笔笔尖坐标(x,y):
步骤s901:原点o′在坐标系r中的坐标为(x0,y0),选取横坐标轴X上任意一点(xm,ym),计算x轴与X轴之间的夹角τ:
步骤s902:计算定位笔笔尖坐标(x,y)在标准坐标系R中的坐标(X,Y),按如下公式:
以校正后的定位笔笔尖坐标(X,Y)作为平面内待测点的坐标,从而实现对待测点的定位。
最后说明的是,以上实施例仅用以说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的宗旨和范围,其均应涵盖在本发明的权利要求范围当中。
Claims (6)
1.一种红外超声平面定位测量装置,其特征在于:包括定位笔以及测量杆;所述定位笔包括笔杆、电源以及信号控制电路,所述笔杆内靠近笔尾与笔尖两端分别设有与笔尖共线的超声波发生波器C1以及超声波发生器C2,笔杆上还设有红外线发生器H0;所述信号控制电路能够产生分别驱动超声波发生波器C1、C2的脉冲信号t1、t2,两个脉冲驱动信号的周期均为T0;脉冲信号t1与脉冲信号t2的时间间隔为T1,0<T1<0.5T0;脉冲信号t1能够同时驱动超声波发生波器C1与红外线发生器H0工作;脉冲信号t2能够同时驱动超声波发生C2与红外线发生器H0工作;
所述测量杆包括单片机、红外线接收器Hs0以及位于测量杆两端的超声波接收器Cs1、Cs2;所述单片机为超声波接收器Cs1、Cs2分别提供计数器J1、J2;在红外线接收器Hs0接收到红外信号时,计数器J1、J2开始计数;在超声波接收器Cs1接收到超声信号时,计数器J1停止计数;在超声波接收器Cs2接收到超声信号时,计数器J2停止计数。
2.根据权利要求1所述的红外超声平面定位测量装置,其特征在于:所述红外线发生器H0设置在笔杆内靠近超声波发生器C2的位置,红外线发生器H0与笔尖共线;电源设置在笔杆中部;信号控制电路设置在靠近超声波发生器C1的位置。
3.根据权利要求1所述的红外超声平面定位测量装置,其特征在于:单片机的晶振为18MHZ,经1/2分频后,为计数器J1、J2提供均为9MHZ的计数频率。
4.根据权利要求1所述的红外超声平面定位测量装置,其特征在于:脉冲信号的周期T0为50ms,脉冲信号t1、t2的时间间隔T1为20ms。
5.一种采用如权利要求1所述的红外超声平面定位测量装置的定位方法,其特征在于:包括以下步骤:
步骤s1:将测量杆水平放置在平面上,将定位笔的笔尖点触到平面的待测点O上;
步骤s2:开启测量杆以及定位笔;两个脉冲信号t1、t2的其中之一驱动定位笔的红外线发生器H0向测量杆发送红外信号,同时驱动超声波发生波器C1、C2中的一个向测量杆发送超声信号;时间间隔T1后,另一脉冲信号驱动定位笔的红外线发生器H0向测量杆发送红外信号,同时驱动超声波发生波器C1、C2中的另一个向测量杆发送超声信号;
步骤s3:测量杆接收到红外信号,计数器J1、J2同时开始计数;之后,测量杆的超声波接收器Cs1、Cs2先后接收到超声信号,计数器J1、J2先后停止计数;
步骤s4:单片机根据识别规则识别当前发送超声信号的超声波发生器,识别规则为:若当前超声信号与上一次超声信号的时差大于0.5T0,则当前超声波发生器为C1;若当前超声信号与上一次超声信号的时差小于0.5T0,则当前超声波发生器为C2;
步骤s5:计算超声波传输时间,按如下规则:
当超声波接收器Cs1、Cs2当前接收到的是超声波发生器C1发送的超声波,则超声波发生器C1到超声波接收器Cs1、Cs2的传输时间分别为T1CS1、T1CS2,按如下公式:
T1CS1=n1cs1×tjs0;其中,n1cs1为计数器J1的计数,tjs0为计数器J1的计数周期;
T1CS2=n1cs2×tjs0;其中,n1cs2为计数器J2的计数,tjs0为计数器J2的计数周期;
当超声波接收器Cs1、Cs2当前接收到的是超声波发生器C2发送的超声波,则超声波发生器C2到超声波接收器Cs1、Cs2的传输时间分别为T2CS1、T2CS2,按如下公式:
T2CS1=n2cs1×tjs0;其中,n2cs1为计数器J1的计数,tjs0为计数器J1的计数周期;
T1CS2=n2cs2×tjs0;其中,n2cs2为计数器J2的计数,tjs0为计数器J2的计数周期;
步骤s6:计算超声波发生器到超声波接收器的距离,设超声波在空气中的传播速度为按如下公式:
超声波发生器C1到超声波接收器Cs1为
超声波发生器C1到超声波接收器Cs2为
超声波发生器C2到超声波接收器Cs1为
超声波发生器C2到超声波接收器Cs2为
步骤s7:分别计算定位笔笔尖到超声波接收器Cs1、Cs2之间的距离LOCS1、LOCS2,按如下公式:
<mrow>
<msub>
<mi>L</mi>
<mrow>
<mi>O</mi>
<mi>C</mi>
<mi>S</mi>
<mn>1</mn>
</mrow>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msubsup>
<mi>L</mi>
<mrow>
<mn>2</mn>
<mi>C</mi>
<mi>S</mi>
<mn>1</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mn>20</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mfrac>
<msub>
<mi>L</mi>
<mn>20</mn>
</msub>
<msub>
<mi>L</mi>
<mn>12</mn>
</msub>
</mfrac>
<mrow>
<mo>(</mo>
<msubsup>
<mi>L</mi>
<mrow>
<mn>2</mn>
<mi>C</mi>
<mi>S</mi>
<mn>1</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mn>12</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>L</mi>
<mrow>
<mn>1</mn>
<mi>C</mi>
<mi>S</mi>
<mn>1</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
<mo>;</mo>
</mrow>
<mrow>
<msub>
<mi>L</mi>
<mrow>
<mi>O</mi>
<mi>C</mi>
<mi>S</mi>
<mn>2</mn>
</mrow>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msubsup>
<mi>L</mi>
<mrow>
<mn>2</mn>
<mi>C</mi>
<mi>S</mi>
<mn>2</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mn>20</mn>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<mfrac>
<msub>
<mi>L</mi>
<mn>20</mn>
</msub>
<msub>
<mi>L</mi>
<mn>12</mn>
</msub>
</mfrac>
<mrow>
<mo>(</mo>
<msubsup>
<mi>L</mi>
<mrow>
<mn>2</mn>
<mi>C</mi>
<mi>S</mi>
<mn>2</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mn>12</mn>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>L</mi>
<mrow>
<mn>1</mn>
<mi>C</mi>
<mi>S</mi>
<mn>2</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>)</mo>
</mrow>
</mrow>
</msqrt>
<mo>;</mo>
</mrow>
其中,L20为笔尖到超声波发生器C2的距离,L12为超声波发生器C1到C1的距离;
步骤s8:以超声波接收器Cs1、Cs2以及定位笔笔尖三点所确定的平面建立平面直角坐标系r:以超声波接收器Cs1为原点o,以超声波接收器Cs1、Cs2之间的连线为y轴,以垂直于y轴的直线为x轴;计算定位笔笔尖与超声波接收器Cs1的连线与y轴的夹角Φ0,按如下公式:
<mrow>
<msub>
<mi>&Phi;</mi>
<mn>0</mn>
</msub>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mo>&lsqb;</mo>
<mfrac>
<mrow>
<msubsup>
<mi>L</mi>
<mrow>
<mn>12</mn>
<mi>C</mi>
<mi>S</mi>
</mrow>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mrow>
<mi>O</mi>
<mi>C</mi>
<mi>S</mi>
<mn>1</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<msubsup>
<mi>L</mi>
<mrow>
<mi>O</mi>
<mi>C</mi>
<mi>S</mi>
<mn>2</mn>
</mrow>
<mn>2</mn>
</msubsup>
</mrow>
<mrow>
<mn>2</mn>
<msub>
<mi>L</mi>
<mrow>
<mn>12</mn>
<mi>C</mi>
<mi>S</mi>
</mrow>
</msub>
<msub>
<mi>L</mi>
<mrow>
<mn>0</mn>
<mi>C</mi>
<mi>S</mi>
<mn>1</mn>
</mrow>
</msub>
</mrow>
</mfrac>
<mo>&rsqb;</mo>
<mo>;</mo>
</mrow>
步骤s9:计算定位笔笔尖在坐标系r中的坐标(x,y),按如下公式:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>x</mi>
<mo>=</mo>
<msub>
<mi>L</mi>
<mrow>
<mi>O</mi>
<mi>C</mi>
<mi>S</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>sin&Phi;</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>y</mi>
<mo>=</mo>
<msub>
<mi>L</mi>
<mrow>
<mi>O</mi>
<mi>C</mi>
<mi>S</mi>
<mn>1</mn>
</mrow>
</msub>
<msub>
<mi>cos&Phi;</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
以定位笔笔尖的坐标作为平面内待测点的坐标,从而实现对待测点的定位。
6.根据权利要求1所述的定位方法,其特征在于:当坐标系r与所测平面的标准坐标系R不重合时,步骤s9还对定位笔笔尖坐标(x,y)进行校正,其中,标准坐标系R的原点为o′,横坐标轴为X,纵坐标轴为Y,按如下步骤校正定位笔笔尖坐标(x,y):
步骤s901:原点o′在坐标系r中的坐标为(x0,y0),选取横坐标轴X上任意一点(xm,ym),计算x轴与X轴之间的夹角τ:
<mrow>
<mi>&tau;</mi>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<msub>
<mi>x</mi>
<mi>m</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
</mrow>
<mrow>
<msub>
<mi>y</mi>
<mi>m</mi>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
步骤s902:计算定位笔笔尖坐标(x,y)在标准坐标系R中的坐标(X,Y),按如下公式:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>X</mi>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&tau;</mi>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&tau;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>Y</mi>
<mo>=</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&tau;</mi>
<mo>+</mo>
<mrow>
<mo>(</mo>
<mi>y</mi>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>0</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&tau;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
以校正后的定位笔笔尖坐标(X,Y)作为平面内待测点的坐标,从而实现对待测点的定位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711015581.6A CN107830847B (zh) | 2017-10-26 | 2017-10-26 | 红外超声平面定位测量装置及定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711015581.6A CN107830847B (zh) | 2017-10-26 | 2017-10-26 | 红外超声平面定位测量装置及定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107830847A true CN107830847A (zh) | 2018-03-23 |
CN107830847B CN107830847B (zh) | 2020-06-23 |
Family
ID=61649455
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711015581.6A Expired - Fee Related CN107830847B (zh) | 2017-10-26 | 2017-10-26 | 红外超声平面定位测量装置及定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107830847B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004102896A (ja) * | 2002-09-12 | 2004-04-02 | Fujitsu Ltd | 超音波型座標入力装置 |
CN1521688A (zh) * | 2003-02-14 | 2004-08-18 | 微软公司 | 确定电子笔笔尖的位置 |
CN1605927A (zh) * | 2003-10-10 | 2005-04-13 | 日本电气视象技术株式会社 | 投影仪及投影仪附件 |
CN1854760A (zh) * | 2005-04-21 | 2006-11-01 | 三星电子株式会社 | 使用超声波估计位置的方法、系统和介质 |
-
2017
- 2017-10-26 CN CN201711015581.6A patent/CN107830847B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004102896A (ja) * | 2002-09-12 | 2004-04-02 | Fujitsu Ltd | 超音波型座標入力装置 |
CN1521688A (zh) * | 2003-02-14 | 2004-08-18 | 微软公司 | 确定电子笔笔尖的位置 |
CN1605927A (zh) * | 2003-10-10 | 2005-04-13 | 日本电气视象技术株式会社 | 投影仪及投影仪附件 |
CN1854760A (zh) * | 2005-04-21 | 2006-11-01 | 三星电子株式会社 | 使用超声波估计位置的方法、系统和介质 |
Also Published As
Publication number | Publication date |
---|---|
CN107830847B (zh) | 2020-06-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101957442B (zh) | 一种声源定位装置 | |
CN206193270U (zh) | 一种一维超声波无线风速风向仪 | |
CN103598888B (zh) | 一种穿戴式人体运动状态数据监测系统及方法 | |
CN103940335A (zh) | 一种工业机器人重复定位精度测量装置 | |
CN106324606A (zh) | 一种笔、测距方法和终端系统 | |
CN106483327A (zh) | 一种超声波测风系统及方法 | |
CN102589504B (zh) | 一种生长中的树木的直径在线测量装置 | |
CN106645792B (zh) | 超声波风速风向测量装置及测量方法 | |
CN101799560A (zh) | 多个声音传感器雷电定位仪及其定位方法 | |
CN103941259A (zh) | 一种具备高抗干扰性的超声波测距方法与测距装置 | |
CN105675125B (zh) | 一种复杂稳定声场声压测试装置智能控制系统 | |
CN103529428A (zh) | 一种基于空间十元阵的点声源被动声定位方法 | |
CN102841343A (zh) | 一种基于工控机的回声测深仪校准系统及其校准方法 | |
CN206876868U (zh) | 一种多路同步超声波测距系统 | |
CN107830847B (zh) | 红外超声平面定位测量装置及定位方法 | |
CN110319805A (zh) | 一种管状物体测量装置及方法 | |
CN107356902B (zh) | 一种WiFi定位指纹数据自动采集方法 | |
CN111624552B (zh) | 一种基于声波渡越时间测量的地下管道定位系统及方法 | |
CN106020364A (zh) | 一种带有静音手机寻觅功能的智能手环及手势识别方法 | |
CN103869096B (zh) | 一种超声波风速仪量程拓宽方法 | |
WO2016045245A1 (zh) | 触摸屏及触摸点定位方法 | |
CN102445169A (zh) | 基于射频无线通信技术的超声波测厚装置 | |
CN110865358A (zh) | 一种测距方法和系统 | |
CN105467396B (zh) | 一种脉冲激光测距控制系统及测距运算方法 | |
CN205426948U (zh) | 一种基于Zigbee无线网络的超声波测风仪 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200623 |
|
CF01 | Termination of patent right due to non-payment of annual fee |