发明内容
本发明提供了一种室内定位方法,包括对移动平台的定位,所述对移动平台的定位具体包括以下步骤:
提供一移动平台、平台定位基站,在所述移动平台设置一信号接收单元与一微处理器,在所述平台定位基站设置一第一信号发射器与第二信号发射器;
所述第一信号发射器与第二信号发射器分别向天花板上散射第一信号群与第二信号群,所述天花板将所述第一信号群与第二信号群向下朝不同的方向反射;
所述移动平台在所述第一信号群与第二信号群的信号覆盖范围内移动,所 述信号接收单元接收所述第一信号群中的一第一信号与所述第二信号群中的一第二信号;
所述信号接收单元将所述第一信号与第二信号发送至所述定位处理器,所述定位处理器接收所述第一信号与第二信号并获取所述第一信号与第二信号的角度信息,同时所述定位处理器获得第一信号与第二信号的反射点高度信息,并根据所述角度信息与高度信息得到自身位置信息。
较佳地,所述信号接收单元包括两个信号接收器,所述两信号接收器设置为面向两个不同的方向接收信号。
较佳地,所述信号接收器包括多个光电传感器,所述各光电传感器分别通过一信号放大电路与一多路复用电路连接,所述多路复用电路依次与带通滤波器、ADC转换器以及微处理器连接。
较佳地,所述多个光电传感器包括第一光电二极管、第二光电二极管、第三光电二极管、第四光电二极管与第五光电二极管,其中所述第一光电二极管、第二光电二极管、第三光电二极管、第四光电二极管分别面对前、后、左、右四个方向,第五光电二极管面向上端。
较佳地,所述定位处理器获取所述第一信号或第二信号的角度I信息的过程为:
信号传入所述微处理器后,所述微处理器可得五个方位角光电信号转换得到的电平大小,得出三个正交轴的信号量值为x,y,z,则其方位角与高度角分别为:
所述信号的角度信息包括方位角α、高度角∈。
较佳地,所述第一信号的与第二信号的角度信息包括第一信号与第二信号的高度角ε1和ε2以及所述第一信号与第二信号的方位角α1与α2,所述第一信号与第二信号的反射点高度信息包括第一信号在天花板上的反射点与第二 信号在天花板上的反射点的高度h1、h2;所述定位处理器得到自身位置信息的过程包括:
将所述平台定位基站与地面的交点设为原点,移动平台在室内的位置设为(x,y);
建立定位方程:
将ε1、ε2、α1、α2、h1、h2带入上述两方程
得到x与y的值。
较佳地,还包括对障碍物的定位,所述对障碍物的定位具体包括以下步骤:
提供一障碍物定位基站,所述障碍物定位基站设置一第三信号发射器,所述第三信号发射器发射一第三信号群至室内天花板,所述室内天花板将所述第三信号群向下方不同方向反射,所述移动平台在所述第三信号群的辐射范围内移动,所述信号接收单元接收所述第三信号群中的一第三信号,并获取所述第三信号的角度信息;;
所述信号接收单元将所述第三信号的角度信息发送至所述定位处理器,所述定位处理器获得所述第三信号在天花板上的反射点高度信息与第三信号角度信息,并根据所述高度信息与角度信息得到所述障碍物定位基站位置信息。
较佳地,所述第三信号的反射点高度信息包括高度h3,所述第三信号的角度信息包括高度角ε3以及方位角α3;所述定位处理器获得所述障碍物定位基站位置信息步骤为:
将所述障碍物定位基站的位置设定为(X,Y)
建立定位方程
将x、y、α3、h3、ε3的值带入上述方程得到X、Y的值。
较佳地,所述各信号发射器为红外信号发射器。
本发明可以用于复杂的室内环境,通过在室内的障碍物上设置障碍物定位基站完成对障碍物的定位,同时对移动平台自身定位,方便监控移动平台与障碍物的距离,避免出现碰撞;本发明采用红外光信号进行定位,获取位置信息的处理过程简单,定位系统的成本较小。
当然,本发明的任一实施方式并不需要达到上述全部技术效果。
具体实施方式
本发明提供了一种室内定位方法,包括对移动平台的定位,所述对移动平台的定位具体包括以下步骤:
提供一移动平台、平台定位基站,在所述移动平台设置一信号接收单元与一微处理器,在所述平台定位基站设置一第一信号发射器与第二信号发射器;
所述第一信号发射器与第二信号发射器分别向天花板上散射第一信号群与第二信号群,所述天花板将所述第一信号群与第二信号群向下朝不同的反向反射;
所述移动平台在所述第一信号群与第二信号群的信号覆盖范围内移动,所述信号接收单元接收所述第一信号群中的一第一信号与所述第二信号群中的一第二信号;
所述信号接收单元将所述第一信号与第二信号发送至所述定位处理器,所述定位处理器接收所述第一信号与第二信号并获取所述第一信号与第二信号的角度信息,同时所述定位处理器获得第一信号与第二信号的反射点高度信息,并根据所述角度信息与高度信息得到自身位置信息。
本实施例所采用的全部信号发射器为红外信号发射器,其向外散射红外光信号。
其中,如图2所示,所述信号接收单元包括两个信号接收器,其功能组成完全相同,朝向角度相反,每个接收器都与水平面呈45°放置,以便接收不同 方向的信号,这样可保证任意时候都至少有一个接收器接收到信号;所述信号接收器包括5个光电传感器,所述各光电传感器分别依次连接信号放大电路、多路复用电路、带通滤波器、ADC转换器与微处理器连接。光电传感器将光信号转换为模拟电信号,之后接入信号放大电路,用于将传感器输出的微弱信号不失真地加以放大,以便于进一步加工和处理,再经过多路复用电路,可将5路信号复合成1路信号;再经过带通滤波器,将无用波段滤除;最后通过ADC转换器将模拟信号转换为数字信号。
所述5个光电传感器包括第一光电二极管、第二光电二极管、第三光电二极管、第四光电二极管与第五光电二极管,其中所述第一光电二极管、第二光电二极管、第三光电二极管、第四光电二极管分别面对前、后、左、右四个方向,第五光电二极管面向上端。当然,本发明也提供的信号接收单元也可以设置一个信号接收器或两个以上的信号接收器,信号接收器的具体结构也可以根据本发明的思想进行变动,本实施例仅为本发明的一较佳实施方式,本发明并不对信号接收器的数量以及其具体组成结构进行限定。
本例中,所述定位处理器获取所述第一信号或第二信号的角度I信息的过程为:
信号传入所述微处理器后,所述微处理器可得五个方位角光电信号转换得到的电平大小,得出三个正交轴的信号量值为x,y,z,则其方位角与高度角分别为:
所述信号的角度信息包括方位角α、高度角∈。
如图1所示,通过上述方法获得的所述第一信号的与第二信号的角度信息包括第一信号与第二信号的高度角ε1和ε2以及所述第一信号与第二信号的方位角α1与α2,所述第一信号与第二信号的反射点高度信息包括第一信号在天花板上的反射点与第二信号在天花板上的反射点的高度h1、h2;所述定位处理 器得到自身位置信息的过程包括:
将所述平台定位基站与地面的交点设为原点,移动平台在室内的位置设为(x,y);
建立定位方程:
将ε1、ε2、α1、α2、h1、h2带入上述两方程
得到x与y的值。
本实施例中,平台定位基站设置在墙面上,其内部的第一信号发射器与第二信号发射器发射第一信号1与第二信号2,第一信号1与第二信号2之间的夹角为θ,本实施例θ设为30度,θ可以根据室内空间的大小进行调制。
第一信号1、第二信号2与天花板交接点的投影中心间距S,及其投射点的高度h1、h2均可测量得出。实际应用中,射向天花板的信号形成的投影不会真的是一个“点”,而是一个圆形的覆盖区域。若定位系统对测量精度要求不是特别高,则可忽略这一点。若对测量精度要求很高,可借助瞄准仪或者激光来精确测定圆心。本例中设定天花板为绝对水平面,故h1等于h2。当装载接收器的移动平台经过该基站有效区域内,接收器利用关键性二极管接收信号,当光电二极管接收到信号后,首先判断信号的调制频率,决定是否增加能量解调器频率。
当移动平台在有高红外干扰的环境下操作,如室内射入阳光,发射器将发射预先设定的、固定波段的红外信号,即可从噪声中识别出发射器的红外信号。
系统实施主要是信号发射器和接收器的部署,接收器一般安装在移动平台的顶部即可,发射器部署根据工作场景调整,分为常规部署方式和特殊部署方式两种。常规部署则参考图1的部署方式,发射基站物理实施方式见图3所示。发射基站为方便获取能源,一般通过室内墙面的双孔插座供电,其次,为不影 响插座正常使用,发射基站本身也自备一个电插座。此外,发射基站在安装时,需仔细检查发射器的安装角度是否正确。
实施例二
在实施例一的基础上,还包括对障碍物的定位,所述对障碍物的定位具体包括以下步骤:
提供一障碍物定位基站,所述障碍物定位基站设置一第三信号发射器,所述第三信号发射器发射一第三信号群至室内天花板,所述室内天花板将所述第三信号群向下放不同方向反射,所述移动平台在所述第三信号群的辐射范围内移动,所述信号接收单元接收所述第三信号群中的一第三信号,并获取所述第三信号的角度信息;;
所述信号接收单元将所述第三信号的角度信息发送至所述定位处理器,所述定位处理器获得所述第三信号在天花板上的反射点高度信息与第三信号角度信息,并根据所述高度信息与角度信息得到所述障碍物定位基站位置信息。
其中所述第三信号的反射点高度信息包括高度h3,所述第三信号的角度信息包括高度角ε3以及方位角α3;所述定位处理器获得所述障碍物定位基站位置信息步骤为:
将所述障碍物定位基站的位置设定为(X,Y)
建立定位方程
将x、y、α3、h3、ε3的值带入上述方程得到X、Y的值。
本实施例可以在室内的障碍物上设置障碍物定位基站,完成对障碍物的定位,方便根据移动平台的自身位置与障碍物的位置控制移动平台在移动到过程中避让障碍物。
以上实施例仅用于举例说明本发明的内容,除上述实施方式外,本发明还有其它实施方式,凡采用等同替换或等效变形方式形成的技术方案均落在本发明的保护范围内。