一种机器人自主充电方法
【技术领域】
[0001] 本发明属于机器人技术领域，尤其涉及一种利用激光测距仪进行充电站自动检测 并进行对接充电的方法。
【背景技术】
[0002] 目前，在机器人运行过程中，如果检测到机器人电量过低时，主要由技术人员控制 机器人运动到充电站位置进行关机或者人工充电操作。此模式下，一方面机器人空闲时会 产生无谓的电量消耗，另一方面，也没有体现出机器人本身的智能性。所以这就需要一种能 够使机器人自主行走到充电站并进行自动对接的方法。
【发明内容】
[0003] 为解决现有针对机器人充电技术的不足，本发明提供了一种基于激光测距仪的机 器人自主充电方法，该方法能够使机器人自主行走到充电站并与充电站进行准确的自动对 接。
[0004] 为实现上述目的，本发明采用如下技术方案：
[0005] 计算所有激光点在机器人坐标系中的坐标；
[0006] 取每三个激光点为一组，分别计算激光点之间的距离结合此三点的激光测量值；
[0007] 判断是否对激光点进行点集分割；
[0008] 对可以分割的激光点进行分割，得到分组后的点集；
[0009] 将分组后的每组点集分割为两组，对每组点集进行最小二乘法的拟合，获得直线 地图集合；
[0010] 根据点集与直线地图集合所包含的参数，判断是否与充电站的特征匹配；
[0011] 匹配的结果为只留有与充电站特征匹配的两条直线，根据两条直线方程以及充电 站在全局坐标中的位置，计算出机器人在全局坐标中的位姿；
[0012] 根据机器人在全局坐标系中的位姿进行与充电站的对接。
[0013] 优选地，在计算所有激光点在机器人坐标系中的坐标之前，先要建立机器人坐标 系，具体为：以机器人当前位置为原点，机器人当前航向为Y轴，以垂直于Y轴的方向为X轴 建立机器人坐标系。
[0014] 优选地，判断是否对激光点进行点集分割，条件为：dis2>阈值l&&dis2To3〈阈值 2 ;结束直线分割的条件是disl>阈值3&&dislT〇2>阈值4。
[0015] 优选地，所述将分组后的每组点集分割为两组，对每组点集进行最小二乘法的拟 合，获得直线地图集合，具体方法为：
[0016] 对所得的点集中的激光点进行激光最小值/最大值的求取；
[0017] 以此点为截点将每组点集分割为两组新点集，并对得到的新点集进行基于最小二 乘法的直线拟合；
[0018] 得到初始直线地图集合。
[0019] 优选地,每条直线地图的信息都包含直线的起点坐标X、起点坐标y、激光起始数 laserstartnum、终点坐标X、终点坐标y、激光终点数laserendnum、线长dline、直线方程参 数kl、直线方程参数k2、直线与激光传感器的距离dis。
[0020] 优选地，判断是否与充电站的特征匹配的方法为：判断直线地图集合中的线长是 否与充电站的长度阈值5匹配，如果不匹配，则在此时刻寻找激光失败。
[0021] 优选地，所述判断是否与充电站的特征匹配的方法还可以为：根据直线地图 集合 InitialMap[i]中 dLine 与阈值 6、InitialMap[i+Ι]中 dLine 与阈值 7 以及由 InitialMap[i]中kl与InitialMap[i+Ι]中kl得到的两直线间角度与阈值8同时满足来 判断是否为充电站；如果没有，则判断寻找充电站失败。
[0022] 优选地，所述根据机器人在全局坐标系中的位姿进行与充电站的对接，包括：
[0023] 机器人根据实时位姿与充电站前方的目标点进行距离偏差，角度偏差的计算；
[0024] 判断机器人角度偏差是否小于阈值1 ;
[0025] 当角度偏差大于阈值9时，机器人原地旋转180°并向后行走一段距离与充电站 对接；
[0026] 当角度偏差小于阈值9时，由增量式PID算法给出机器人的角速度，而线速度由角 速度的反比来进行计算；
[0027] 将机器人的线速度、角速度转化为电机转速发送给电机；进行与充电站的对接；
[0028] 判断是否充电成功；
[0029] 如果是，则充电完成；如果否，则重复此步骤。
[0030] 本发明较现有技术，有如下方面的有益效果：
[0031] 1、不仅仅可以提高机器人的续航能力，还可以保证人员与机器人本身的安全性。
[0032] 2、目前的机器人充电由人工进行操作，机器人在空闲时段进行这无谓的电量损 耗，不利于机器人长期运行，影响了机器人的作业能力。同时人工充电时如果充电口结构不 合理或者端口老化，技术人员容易操作失误造成人或机器人的损伤。
[0033] 3、通过本发明的方法，可以使机器人在空闲或者电量不足时自动寻找充电站并进 行对接充电，提高了机器人的续能性与智能性。
[0034] 4、采用激光的方法可以确保对接的准确性。
【附图说明】
[0035] 图1是本发明充电方法整体流程图；
[0036] 图2是本发明对接方法流程图。
【具体实施方式】
[0037] 为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对 本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并 不用于限定本发明。
[0038] 参考图1所示，一种机器人自主充电方法，包括如下步骤：
[0039] SlO :计算所有激光点在机器人坐标系中的坐标。
[0040] 以机器人当前位置为原点，机器人当前航向为Y轴，以垂直于Y轴的方向为X轴建 立机器人坐标系，在该坐标系中，以机器人当前位置为圆心，在机器人正前方270°范围内， 每隔0. 25°就有激光传感器打出的一个激光点，共计产生1081个激光点，即有1081个激光 数据laserdata[i]。分别计算1081个激光点在机器人坐标系中的坐标。计算公式如下：
[Iaserx [/] = Iaserdata [/] * cos( i * 0.25)
[0041] {
[lasery [/] = Iasenlata [/] * sin( i * 0.25)
[0042] S20 :取每三个激光点为一组，分别计算激光点之间的距离以及到激光传感器之间 的距离。
[0043] 得到激光点的坐标后，取每三个激光点为一组，分别计算三个激光点之间的距离 dislTo2、dis2To3以及三个激光点的距离值disl、dis2、dis3。
[0044] S30 :判断是否对激光点进行点集分割。
[0045] 根据上述每三个激光点之间的距离以及每三个激光点的距离值判断是否对激光 点进行点集分割。开始分割的条件为：dis2>阈值l&&dis2T 〇3〈阈值2 ;结