室内无源导航定位系统和方法技术方案

本发明专利技术公开了一种室内无源导航定位系统和方法。本系统包括深度摄像机Kinect，惯性导航和标示符，Kinect和惯性导航连接到工控机SBC84823，标示符独立张贴在墙上；Kinect得到标示符的图像数据和深度数据，惯性导航测得自身的姿态角之后，通过USB接口将深度数据和图像数据传入到工控机SBC84823，由工控机SBC84823计算出机器人自身的坐标位置。本发明专利技术的方法是:首先要根据数字识别技术识别出图像中标示符的世界坐标，计算出标示符相对于机器人（Kinect）的相对坐标；然后根据惯性导航测出机器人自身的姿态角和机器人的待求坐标组成变换矩阵得到变换方程，根据方程组求得机器人的自身的坐标。本发明专利技术的实施例主要用于图中机器人的坐标位置的检测和计算。

【技术实现步骤摘要】
室内无源导航定位方法
本专利技术公开了一种室内无源导航定位方法，涉及深度图像数据，图行识别技术，图像处理技术和机器人工学领域。
技术介绍
地质灾害发生的时候，比如地震或者放射性物质泄漏，都可能造成室内环境的不安全，这个时候人工进行救援操作会有很大的危险，当这种特殊情况发生后，应用机器人进行勘察和救援维护，将成为不可替代的趋势。然而室内环境导致许多通用的机器人救援措施变得无法实施，例如最为重要的移动机器人导航。室内环境不可接受GPS信号，墙壁等障碍物也阻碍了各种无线信号的传输，室内导航本身就是现代的机器人研究难点之一。尤其在放射性物质泄漏的环境，不仅信号难以传输，核辐射将摧毁一切有源设备，例如电池，电子元件，因此传统的室内导航，例如有源RFID，超声波器件等有源设备在核放射环境下都无能为力。常见的室内导航有RFID技术，超声波技术，红外线技术，室内地图导航等。RFID技术分为有源RFID和无源RFID，有源RFID要求在核电站内部放置RFID发射器，这种有源设备显然在核放射环境下是不可使用的，而无源RFID的无源也是相对的，其内部也集成有射频信号发射芯片，这种芯片长期地处在放射环境下必然是无法工作的，况且无源RFID的信号较弱，不易被检测到。超声波技术则要求在核电站外部发射超声波信号，通过多普勒效应或反射测距法进行定位，但是核电站内部存在各种设备阻碍，如厚实的墙壁，小功率的超声波信号一般是无法穿透的，而大功率的超声波信号则要求大型的发射设备，这在现实的紧急救援环境中也是不现实的。相对超声波定位而言，红外线定位则更加易受干扰和阻碍，没有显著的实用价值。况且超声波和红外线定位最后都实现的是相对位置的定位，没有办法得到绝对的位置。如果我们拥有在灾害发生内部的三维地图，进行地图匹配导航是可行的，然而在大多数突发的灾害环境下，我们未必拥有其内部的环境地图数据，或者环境会发生很大的变化。
技术实现思路
为了克服上述现有技术的不足，本专利技术提供一种室内无源导航定位方法，利用Kinect的RGBD(色彩与深度信息)在室内环境下进行准确定位，实现机器人在不需要任何室内有源设备、无外界信号的环境下的定位。为了达到上述目的，本专利技术的构思是：首先由Kinect采集环境中包含标示符的深度数据和图像数据，由惯性导航检测机器人自身的姿态角；然后将深度数据，图像数据和姿态角传送到工控机进行图像处理和计算分析，最终得到机器人自身的世界坐标值。本专利技术的室内无源导航定位方法包括：(1)RGBD数据输入：Kinect通过USB接口传入到工控机上，将图像数据和深度数据同时输送到工控机上以供处理；(2)数据处理系统：工控机SBC84823作为控制器处理RGBD和机器人自身的姿态角数据；(3)姿态角数据输入：惯性导航通过另一USB接口接到工控机上，将同时的机器人的姿态角数据传输到工控机上以供处理；(4)环境标示符：标示符是一个完全无源的标识，用于储存标识的位置信息，被Kinect检测到以实现定位。根据上述专利技术构思，本专利技术采用下述技术方案：一种室内无源导航定位方法，包括深度摄像机Kinect。机器人处于室内环境，深度摄像机Kinect集成于机器人内部，与机器人内部的工控机SBC84823通过USB串口连接。所述的工控机对深度摄像机Kinect传回的图像数据和深度数据的进行处理。上述室内无源导航定位方法，还有一个xsens惯性导航集成于机器人内部，与工控机SBC84823通过另一个USB串口连接。工控机SBC84823对惯性导航测量的自身姿态角的进行处理。上述室内无源导航定位方法，在室内还安置一个标示符。该标示符是一种包含了数字的编码，包含了标示符的位置信息，作为图像数据被Kinect采集；标示符包含两个部分，匹配区和数字区两部分：匹配区包含三个由显著特征组成的匹配模板，并且在与数字区四个角相接的地方有黄色的小点，用以对标示符进行精确的定位；数字区在匹配区的中间，定位校正后，数字信息可以通过数字字形识别的方法识别出来。该内无源导航定位方法，采用上述的机器人定位方法进行定位，其特征在于，检测步骤如下：步骤1：机器人在室内运行，并利用Kinect采集建筑内部的图像数据和深度数据，并将数据传输给工控机；步骤2：工控机对图像数据进行检测以找到标示符，检测方法如下：机器人通过模板匹配法在拍摄的图像数据中，利用模板匹配法检测标示符的三个定位点坐标：右上定位点(XRU,YRU)、左下定位点(XLD,YLD)、右下定位点(XRD,YRD)，然后，由矩形的顶点位置关系可得标示符的左上定位点的坐标(XLU,YLU)，XLU＝XRU+XLD-XRD，YLU＝YRU+YLD-YRD；步骤3：对步骤2已找到的标示符进行数字区的分割和提取，处理如下：①扩搜索范围：以模板匹配法搜索出的像素坐标为中心，向外扩展15-30个像素点；②定位点微调：当算法搜索到微调区颜色像素值(255,255,0)时，机器人更新定位点到标示符的微调区，实现定位点的微调；③矫正转角偏移：根据步骤2得到的坐标值代入angle＝arctan[(XLU-XLD)/(YLD-YLU)]将图片旋转，矫正标识在图片上的转角偏移，正值表示逆时针旋转；④提取数字区：根据旋转后的四个顶点坐标对图像进行分割提取；步骤4：工控机利用数字字形识别法对标示符的数字区进行解码，从而获取标识相对世界坐标系的坐标步骤5：根据Kinect获得的深度数据，利用Kinect的特性计算出标示符左上角定位点相对于Kinect坐标系的坐标具体计算按照如下公式进行：其中XLU和YLU是左上角定位点在图像中的坐标，Z0是Kinect特性参考平面的距离，d是Kinect发射激光经过实际平面和参考平面映射在图像上的距离，b是Kinect激光发射器和相机的距离，f是相机的焦距。步骤6：根据惯性导航和待求的未知的机器人在世界坐标系的坐标推导出机器人Kinect坐标系O′-X′Y′Z′相对于世界坐标系O-XYZ的变换矩阵，具体按照如下步骤进行：①由固定在机器人上的惯性导航测出机器人自身的姿态角α,β,γ：其中γ是机器人绕X轴旋转的角度(俯仰角)，β是机器人绕Y轴旋转的角度(滚转角)，α是机器人绕Z轴旋转的角度(偏航角)；利用姿态角α,β,γ计算出机器人坐标系O-X′Y′Z′相对于世界坐标系O-XYZ的旋转矩阵：计算出机器人坐标系O-X′Y′Z′相对于世界坐标系O-XYZ的变换矩阵：其中是机器人相对于世界坐标的坐标，即机器人在房间中的位置；步骤7：为标示符在世界坐标系O-XYZ下的坐标；为标示符在Kinect坐标系O-X′Y′Z′下的坐标。Kinect坐标系O′-X′Y′Z′相对世界坐标系O-XYZ的姿态变换矩阵已知，根据机器人工学坐标系映射可知：可得到下式：机器人的坐标通过上式中l，m，n值就可以确定机器人的位置。步骤8：倘若在图像中未检测到标识的存在，调整机器人的姿态和位置，重新进行步骤1。本专利技术与现有技术相比，具有如下显而易见的突出实质性特点和显著优点：本专利技术并不需要在室内布置有源的设备，防止了意外事故停电或者核辐射干扰导致定位方法失灵，标示符简单易操作而且整个定位系统成本很低。附图说明图1为本专利技术的系统硬件图和基本原理图；图2为本专利技术的步骤流程图；图3为本文档来自技高网...

【技术保护点】
一种室内无源导航定位系统，包括深度摄像机Kinect（1），其特征在于：机器人（5）处于室内辐射环境，深度摄像机Kinect（1）集成于机器人（5）内部，与机器人（5）内部的工控机SBC84823（2）通过USB串口连接；所述的工控机（2）对深度摄像机Kinect（1）传回的图像数据和深度数据的进行接收和处理。

【技术特征摘要】
1.一种室内无源导航定位方法，该方法用于一种室内无源导航定位系统的定位，该室内无源导航定位系统包括：机器人(5)处于室内辐射环境，深度摄像机Kinect(1)集成于机器人(5)内部，与机器人(5)内部的工控机SBC84823(2)通过USB串口连接；工控机(2)对深度摄像机Kinect(1)传回的图像数据和深度数据进行接收和处理；该室内无源导航定位系统还有一个Xsens惯性导航(3)集成于机器人(5)内部，与工控机SBC84823(2)通过另一个USB串口连接；工控机SBC84823(2)对Xsens惯性导航(3)测量的自身姿态角进行接收和处理；另外，该室内无源导航定位系统在室内还安置一个标识符(4)，该标识符(4)包含有标识符的位置的数学图形，作为图像数据被Kinect(1)采集；该室内无源导航定位方法的特征在于，操作步骤如下：步骤1：机器人(5)在室内运行，并利用Kinect(1)采集建筑内部的图像数据和深度数据，并将数据传输给工控机(2)；步骤2：工控机(2)处理系统通过模板匹配方法，对图像数据进行模板匹配以找到定位标示符(4)的匹配区，识别并定位出数字区的三个角的坐标，即右上定位点(XRU,YRU)、左下定位点(XLD,YLD)、右下定位点(XRD,YRD)，然后，由矩形的顶点位置关系可得标示符的左上定位点的坐标(XLU,YLU)，XLU＝XRU+XLD-XRD，YLU＝YRU+YLD-YRD；倘若在图像中未检测到标识的存在，调整机器人(5)的姿态和位置，重新进行步骤1；步骤3：对步骤2已找到的标示符(4)进行数字区的分割和提取；步骤4：工控机(2)利用数字识别技术对标示符(4)内的数字进行识别，从而获取标识相对世界坐标系的坐标步骤5：根据Kinect(1)获得的深度数据，和Kinect的特性计算出标示符(4)左上角定位点相对于Kinect坐标系的坐标具体计算按照如下公式进行：其中XLU和YLU是左上角定位点在图像中的坐标，Z0是Kinect特性参考平面的距离，d是Kinect(1)发射激光经过实际平面和参考平面映射在图像上的距离，b是Kinect(1)激光发射器和相机的距离，f是相机的焦距；步骤6：根据惯性导航(3)和待求的未知的机器人(5)在世界坐标系的坐标推导出机器人(5)Kinect坐标系O′-X′Y′Z′相对于世界坐标系的变换矩阵，具体按照如下步骤进行：①由固定在机器人上的惯性导航(3)测出机器人(5)自身的姿态角α,β,γ：其中γ是机器人(5)绕X轴旋转的角度——俯仰角，β是机器人...

【专利技术属性】
技术研发人员：蒲华燕，张娟，顾建军，罗均，谢少荣，马捷，颜春明，瞿栋，
申请(专利权)人：上海大学，
类型：发明
国别省市：上海;31