基于机器人的自动充电方法技术

本申请公开了一种基于机器人的自动充电方法，包括机器人和充电桩，所述充电桩两端分别安装超声波发射器，且两个超声波发射器的中间位置安装有红外发射器，包括：在控制机器人导航至充电桩预设范围内后，根据所述机器人接收到的所述充电桩两端发送的超声波信号计算所述机器人的位姿状态；根据所述位姿状态调整所述机器人的位姿，使得所述机器人移动至所述充电桩的中心线上；控制所述机器人沿所述中心线向所述充电桩移动；在所述机器人向所述充电桩移动过程中，根据所述机器人接收到的红外信号调整所述机器人的位姿，直至使所述机器人和所述充电桩二者的电极位置对准并接触。本发明专利技术能够灵活调整机器人姿态，提高定位的精确度。

【技术实现步骤摘要】
基于机器人的自动充电方法
本申请涉及机器人
，具体而言，涉及一种基于机器人的自动充电方法。
技术介绍
机器人的传统充电方式是人工将机器人与充电桩连接进行接触式或插入式充电，并不能充分发挥机器人的智能化。如何实现机器人自动去移动寻找充电桩进行自动充电成为当前的研究重点。目前机器人充电主要采用红外对准装置，因红外传感器只能表示0和1，因此在位置偏差的情况下，不能灵活准确调整机器人姿态，且红外传感器易受强光及玻璃等透明物的影响，抗干扰性较差。并且在机器人与充电座相距较近时都有一定的对准定位局限性，如精度不够、缺乏交互性等问题。
技术实现思路
本申请的主要目的在于提供一种灵活准确调整机器人姿态，提高定位精确度并增强交互性的定位方案。为了实现上述目的，根据本申请的一个方面，提供了一种基于机器人的自动充电方法，包括机器人和充电桩，所述充电桩两端分别安装超声波发射器，且两个超声波发射器的中间位置安装有红外发射器，包括：在控制机器人导航至充电桩预设范围内后，根据所述机器人接收到的所述充电桩两端发送的超声波信号计算所述机器人的位姿状态；根据所述位姿状态调整所述机器人的位姿，使得所述机器人移动至所述充电桩的中心线上；控制所述机器人沿所述中心线向所述充电桩移动；在所述机器人向所述充电桩移动过程中，根据所述机器人接收到的红外信号调整所述机器人的位姿，直至使所述机器人和所述充电桩二者的电极位置对准并接触。进一步，所述根据所述机器人接收到的所述充电桩两端发送的超声波信号计算所述机器人的位姿状态，包括：控制所述机器人从当前位置进行多次旋转，得到所述机器人在每次旋转后的位置处与所述充电桩一端距离，得到距离值集合，每次旋转的角度均为预设角度；将所述距离集合中每个距离进行比较，得到值最小的距离；根据旋转次数得到所述机器人在值最小的距离位置的角度θ，根据角度θ以及所述机器人在值最小的距离位置处接收到的所述充电桩两端发送的超声波信号计算所述机器人的移动至所述充电桩的中心线的距离L；根据角度θ和距离L得到所述机器人的位姿状态。进一步，所述将所述距离集合中每个距离进行比较前，还包括：将所述距离集合中每个距离与距离阈值进行比较，判断是否全部无效；如果全部无效，则向上位机发送提示信息，所述提示信息为故障设备的预估信息。进一步，所述上位机包括手机、pad、PC机或笔记本。进一步，在所述控制所述机器人从当前位置进行多次旋转之前，包括：根据所述机器人接收到的所述充电桩一端发送的超声波信号计算当前距离；将所述当前距离与无效距离范围进行比较，判断所述当前距离是否无效；如果无效，则控制所述机器人旋转，否则不做处理。进一步，所述根据所述位姿状态调整所述机器人的位姿，使得所述机器人移动至所述充电桩的中心线上，包括：按照距离L控制所述机器人移动至所述充电桩的中心线上；将所述角度与角度阈值进行比较；如果所述角度大于角度阈值，则控制所述机器人在所述充电桩的中心线上进行旋转，旋转方向与原需旋转方向相反，否则旋转方向与原需旋转方向相同。进一步，所述预设角度阈值为90度。进一步，所述根据所述机器人接收到的红外信号调整所述机器人的位姿，包括：根据所述机器人接收到红外信号，计算所述机器人与所述充电桩两端的距离Dl、Dr；判断Dl与Dr的差是否大于预设偏差；如果大于预设偏差，则控制所述机器人按照预设的微调角度向Dr方向旋转，否则向Dl方向旋转。进一步，所述预设偏差为2。进一步，所述微调角度为3。在本申请实施例中，采用超声波信号和红外信号实现对所述机器人位姿进行调整的方式，通过超声波信号进行位姿调整的方式，达到了降低干扰的目的，再利用红外信号进行位姿微调从而实现了通过所述充电桩向所述机器人充电的精准性。附图说明构成本申请的一部分的附图用来提供对本申请的进一步理解，使得本申请的其它特征、目的和优点变得更明显。本申请的示意性实施例附图及其说明用于解释本申请，并不构成对本申请的不当限定。在附图中：图1为本专利技术所述的基于机器人的自动充电方法一个实施例的流程示意图；图2为根据超声波计算所述机器人的位姿状态的具体工作流程示意图；图3为控制所述机器人移动至所述充电桩的中心线上的具体工作原理流程示意图；以及图4为本申请中根据所述机器人接收到的红外信号调整所述机器人的位姿流程示意图。具体实施方式为了使本
的人员更好地理解本申请方案，下面将结合本申请实施例中的附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本申请一部分的实施例，而不是全部的实施例。基于本申请中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都应当属于本申请保护的范围。需要说明的是，本申请的说明书和权利要求书及上述附图中的术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含，例如，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。需要说明的是，在不冲突的情况下，本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本申请。超声波遇到任何障碍都会反射，因此可以根据反射的信息进行计算；但是红外遇到玻璃会发生折射和透射，也容易受强光影响，而超声波是不完全受这些影响的。因此为了解决现有的利用红外实现机器人接触式充电易受干扰的问题，本专利技术提供一种基于机器人的自动充电方法。如图1为本专利技术所述的基于机器人的自动充电方法一个实施例的流程示意图。所述方法包括机器人和充电桩，所述充电桩两端分别安装超声波发射器，且两个超声波发射器的中间位置安装有红外发射器，具体包括S101～S104。S101、在控制所述机器人导航至所述充电桩预设范围内后，根据所述机器人接收到的所述充电桩两端发送的超声波信号计算所述机器人的位姿状态。由于所述机器人导航至所述充电桩预设范围后，与所述充电桩还有一定距离，实现所述机器人的接触式充电，仍需要控制所述机器人与所述充电桩电极的位置对准。实际应用中，所述机器人一般应用在商场、医院等公众场所，在这种公众场所障碍物较多，严重影响对准过程。S102、根据所述位姿状态调整所述机器人的位姿，使得所述机器人移动至所述充电桩的中心线上。位姿包括位置和方向。具体地，位置及方向均可以通过建立坐标系进行确定，最终保证所述机器人移动至所述充电桩的中心线上。所述红外发射器位于两个所述超声波发射器的中间位置，即处于所述中心线所在平面。S103、控制所述机器人沿所述中心线向所述充电桩移动。S104、在所述机器人向所述充电桩移动过程中，根据所述机器人接收到的红外信号调整所述机器人的位姿，直至使所述机器人和所述充电桩二者的电极位置对准并接触。因此本申请通过超声波信号和红外信号对所述机器人进行两次位姿调整：利用抗干扰性强的超声波信号实现调整所述机器人位姿，降低障碍物对信号的影响，保证所述机器人移动至所述充电桩中心线附近，防止所述机器人无法移动至所述充电桩位姿处，然后利用超声波信号进行微调；红外信号是作为辅助校准，提高可靠性，保证所述机器人与所述充电桩对准接触，实现机器人充电的自动化、智能化。本申请首先利用超声波计算得到所述机器人第一位本文档来自技高网...

【技术保护点】
一种基于机器人的自动充电方法，其特征在于，包括机器人和充电桩，所述充电桩两端分别安装超声波发射器，且两个超声波发射器的中间位置安装有红外发射器，包括：在控制机器人导航至充电桩预设范围内后，根据所述机器人接收到的所述充电桩两端发送的超声波信号计算所述机器人的位姿状态；根据所述位姿状态调整所述机器人的位姿，使得所述机器人移动至所述充电桩的中心线上；控制所述机器人沿所述中心线向所述充电桩移动；在所述机器人向所述充电桩移动过程中，根据所述机器人接收到的红外信号调整所述机器人的位姿，直至使所述机器人和所述充电桩二者的电极位置对准并接触。

【技术特征摘要】
1.一种基于机器人的自动充电方法，其特征在于，包括机器人和充电桩，所述充电桩两端分别安装超声波发射器，且两个超声波发射器的中间位置安装有红外发射器，包括：在控制机器人导航至充电桩预设范围内后，根据所述机器人接收到的所述充电桩两端发送的超声波信号计算所述机器人的位姿状态；根据所述位姿状态调整所述机器人的位姿，使得所述机器人移动至所述充电桩的中心线上；控制所述机器人沿所述中心线向所述充电桩移动；在所述机器人向所述充电桩移动过程中，根据所述机器人接收到的红外信号调整所述机器人的位姿，直至使所述机器人和所述充电桩二者的电极位置对准并接触。2.根据权利要求1所述的方法，其特征在于，所述根据所述机器人接收到的所述充电桩两端发送的超声波信号计算所述机器人的位姿状态，包括：控制所述机器人从当前位置进行多次旋转，得到所述机器人在每次旋转后的位置处与所述充电桩一端距离，得到距离值集合，每次旋转的角度均为预设角度；将所述距离集合中每个距离进行比较，得到值最小的距离；根据旋转次数得到所述机器人在值最小的距离位置的角度θ，根据角度θ以及所述机器人在值最小的距离位置处接收到的所述充电桩两端发送的超声波信号计算所述机器人的移动至所述充电桩的中心线的距离L；根据角度θ和距离L得到所述机器人的位姿状态。3.根据权利要求2所述的方法，其特征在于，在所述将所述距离集合中每个距离进行比较前，还包括：将所述距离集合中每个距离与距离阈值进行比较，判断是否全部无效；如果全部无效，则...

【专利技术属性】
技术研发人员：石永亮，张伟民，张华，黄强，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：北京,11