技术摘要：
本发明公开了一种移动式机器人充电站自动对准的视觉引导方法，所述视觉引导方法通过在充电站上设置多个标志物，测量各个标志物在充电站坐标系中的三维坐标；然后通过移动机器人自带的光学相机实时拍摄标志物的图像，并利用相机标定得到的畸变参数对各个图像坐标进行畸  全部
背景技术：
移动式智能机器人通常是一种自带充电电池作为动力源，具有环境地图构建、定 位以及路径规划跟踪的一种自动化智能设备。它可以按照预先编定的程序或者人为输入的 指令自动完成各种任务。目前移动式机器人广泛应用于电力、化工、核能、制造、侦查、巡检、 家庭、银行或商场服务等领域。电池续航能力是制约机器人应用的一个重要因素。通常机器 人应用场景会要求机器人具有自动充电能力。机器人实现自动充电功能首先要求机器人能 通过自身的导航设备引导机器人到达充电站附近，然后机器人利用充电设备的二次定位能 力完成充电电极的对接，或者无线充电线圈对齐。对接之后才能实现充电功能。机器人在环 境中的定位精度常在厘米级，但是为了将电极或者线圈进行准确的对接要求定位精度达到 毫米级别。目前市面上现有的自动充电方案多为红外引导或者无线信号引导。例如申请公 布号为CN108508897A的发明专利申请公开了“一种基于视觉的机器人自动充电对准系统及 方法”，所述机器人自动充电对准系统在充电座上安装主动式视觉引导装置，在移动机器人 充电端安装普通相机，通过相机捕捉图像中的引导标记，根据标记位置及视觉特征计算得 到机器人相对充电座的位置及大致角度，然后采用对准运动控制算法使机器人准确对齐充 电座。所述机器人自动充电对准系统无需在地上铺设磁条或二维码等定位标记，因此不存 在因为人或机械原因磨损而失效的问题。且所述机器人自动充电对准方法中对移动机器人 相对位置的计算可以达到图像像素级的精度，实时性好，精度高。与对于充电座本体的图像 识别方案相比，所述机器人自动充电对准系统中的主动式视觉引导装置主动发射标记信 号，识别简单，具有较高的信噪比，可以与背景明显区别，因此引导定位更加稳定可靠。 然而上述的机器人自动充电对准系统需要在机器人上额外安装充电模块和对位 模块，实施成本高。另外，上述的机器人自动充电对准方法的定位精度依然不高，有待改进。
技术实现要素：
本发明的目的在于克服现有技术的不足，提供一种移动式机器人充电站自动对准 的视觉引导方法，所述视觉引导方法不仅实施成本低，而且能够精确地使得移动机器人的 充电端子与充电站的充电接口自动对准，并且定位精度更高。 本发明解决上述技术问题的技术方案是： 一种移动式机器人充电站自动对准的视觉引导方法，包括以下步骤： 步骤1：在充电站上设置多个标志物，测量各个标志物在充电站坐标系中的三维坐 标(xi,yi,zi)； 步骤2：对移动机器人自带的光学相机进行相机标定，获取该光学相机的内参矩阵 Rcam和畸变参数Tdis； 4 CN 111572377 A 说　明　书 2/4 页 步骤3：当移动机器人运动到充电站周围时，通过其自身携带的光学相机拍摄各个 标志物的图像，然后将拍摄到的图像进行处理，得到各个标志物在光学相机坐标系中的图 像坐标(ui,vi)； 步骤4：通过利用相机标定得到的光学相机的畸变参数Tdis对各个标志物的图像坐 标进行畸变校正，校正后的无畸变图像坐标为(Ui,Vi)； 步骤5，取多组标志物的无畸变图像坐标和对应标志物在充电站坐标系中的三维 坐标进行换算，得到充电站坐标系相对于机器人光学相机坐标系的位姿tarTcam； 步骤6：通过光学相机在机器人坐标系中的位姿camTrobot和充电站坐标系相对于机 器人光学相机坐标系的位姿tarTcam计算充电站在机器人坐标系中的位姿tarTrobot，其中， tarT ＝tarrobot T camcam· Trobot； 步骤7：根据充电站在机器人坐标系中的位姿tarTrobot，在充电站的正前方插入预对 准中继点坐标系，接着，移动机器人到达该中继点；最后，移动机器人从中继点运动到充电 站处，使得移动机器人上的充电端子与充电站的充电接口接触，完成充电。 优选的，在步骤1中，标志物为四个或四个以上颜色不同的LED灯，所述LED灯安装 在充电站上。 优选的，在步骤2中，光学相机的内参矩阵Rcam的计算公式为： 其中，f为镜头焦距；dx，dy为光学相机像素的物理尺寸；u0，v0为图像中心坐标； 所述光学相机的畸变参数Tdis的计算公式为： Tdis＝[k1  k2  k3  p1  p ]T2 ； 其中，k1,k2,k3为镜头径向畸变系数，p1,p2为镜头切向畸变系数。 优选的，在步骤3中，所述移动机器人上的光学相机在拍摄各个不同颜色的LED灯 的图像后，将图像由RGB空间转换为HSV空间，同时提取各个LED灯在HSV空间的H通道的色相 值，并通过HSV图像的H通道检测各种颜色的LED的图像坐标(ui,vi)。 优选的，将拍摄到的图像由RGB空间转换到HSV空间，其中，HSV图像的H通道为图片 的色相通道，根据LED灯的色相值，在H通道中选出与LED灯的灯色相值附近的像素点的集 合，计算该集合中像素点的坐标的平均值即为该LED灯的图像坐标(ui,vi)。 优选的，在步骤5中，取四组或四组以上的标志物的无畸变图像坐标和对应标志物 在充电站坐标系中的三维坐标进行PnP解算，得到充电站坐标系相对于机器人光学相机坐 标系的位姿tarTcam； 优选的，在步骤5中，充电站坐标系相对机器人光学相机坐标系的位姿tarTcam的计 算公式为： 5 CN 111572377 A 说　明　书 3/4 页 其中， 为充电站坐标系在机器人坐标系中的方向余弦矩阵，t ＝[tx  ty  t ]Tz ，为充电站坐标系在机器人坐标系中的平移向量。 本发明与现有技术相比具有以下的有益效果： 1、本发明的移动式机器人充电站自动对准的视觉引导方法不需要在移动机器人 上增加额外的充电站测量装置，仅利用自身携带的光学相机就可以实施本发明的视觉引导 方法，这不仅有利于简化移动机器人的硬件配置，降低机器人硬件成本，而且还可以减轻移 动机器人的重量，使其反应更加灵敏。 2、本发明的移动式机器人充电站自动对准的视觉引导方法对充电站的设计要求 低，在定位与对准的过程不需要与充电站进行数据通讯，可以简化充电站的结构。 3、本发明的移动式机器人充电站自动对准的视觉引导方法可以极大地提高精位 和对准精度，且当移动机器人逐渐靠近充电站时，测量精度会随着距离的减小而提高，有利 于精准对位。 附图说明 图1为实施本发明的移动式机器人充电站自动对准的视觉引导方法的充电站和移 动机器人的结构示意图。 图2为本发明的移动式机器人充电站自动对准的视觉引导方法中的中继点坐标 系，充电站坐标系和机器人坐标系的示意图。