CN104635730B - 一种机器人自主充电方法 - Google Patents
一种机器人自主充电方法 Download PDFInfo
- Publication number
- CN104635730B CN104635730B CN201310574088.3A CN201310574088A CN104635730B CN 104635730 B CN104635730 B CN 104635730B CN 201310574088 A CN201310574088 A CN 201310574088A CN 104635730 B CN104635730 B CN 104635730B
- Authority
- CN
- China
- Prior art keywords
- robot
- charging station
- laser spots
- point set
- laser
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种机器人自主充电方法,包括:计算所有激光点在机器人坐标系中的坐标;取每三个激光点为一组,分别计算激光点之间的距离结合此三点的激光测量值;判断是否对激光点进行点集分割;对可以分割的激光点进行分割,得到分组后的点集;将分组后的每组点集分割为两组,对每组点集进行最小二乘法的拟合,获得直线地图集合;根据点集与直线地图集合所包含的参数,判断是否与充电站的特征匹配;匹配的结果为只留有与充电站特征匹配的两条直线,根据两条直线方程以及充电站在全局坐标中的位置,计算出机器人在全局坐标中的位姿;根据机器人在全局坐标系中的位姿进行与充电站的对接。提高了机器人充电的准确性。
Description
技术领域
本发明属于机器人技术领域,尤其涉及一种利用激光测距仪进行充电站自动检测并进行对接充电的方法。
背景技术
目前,在机器人运行过程中,如果检测到机器人电量过低时,主要由技术人员控制机器人运动到充电站位置进行关机或者人工充电操作。此模式下,一方面机器人空闲时会产生无谓的电量消耗,另一方面,也没有体现出机器人本身的智能性。所以这就需要一种能够使机器人自主行走到充电站并进行自动对接的方法。
发明内容
为解决现有针对机器人充电技术的不足,本发明提供了一种基于激光测距仪的机器人自主充电方法,该方法能够使机器人自主行走到充电站并与充电站进行准确的自动对接。
为实现上述目的,本发明采用如下技术方案:
计算所有激光点在机器人坐标系中的坐标;
取每三个激光点为一组,分别计算激光点之间的距离结合此三点的激光测量值;
判断是否对激光点进行点集分割;
对可以分割的激光点进行分割,得到分组后的点集;
将分组后的每组点集分割为两组,对每组点集进行最小二乘法的拟合,获得直线地图集合;
根据点集与直线地图集合所包含的参数,判断是否与充电站的特征匹配;
匹配的结果为只留有与充电站特征匹配的两条直线,根据两条直线方程以及充电站在全局坐标中的位置,计算出机器人在全局坐标中的位姿;
根据机器人在全局坐标系中的位姿进行与充电站的对接。
优选地,在计算所有激光点在机器人坐标系中的坐标之前,先要建立机器人坐标系,具体为:以机器人当前位置为原点,机器人当前航向为Y轴,以垂直于Y轴的方向为X轴建立机器人坐标系。
优选地,判断是否对激光点进行点集分割,条件为:dis2>阈值1&&dis2To3<阈值2;结束直线分割的条件是dis1>阈值3&&dis1To2>阈值4。
优选地,所述将分组后的每组点集分割为两组,对每组点集进行最小二乘法的拟合,获得直线地图集合,具体方法为:
对所得的点集中的激光点进行激光最小值/最大值的求取;
以此点为截点将每组点集分割为两组新点集,并对得到的新点集进行基于最小二乘法的直线拟合;
得到初始直线地图集合。
优选地,每条直线地图的信息都包含直线的起点坐标x、起点坐标y、激光起始数laserstartnum、终点坐标x、终点坐标y、激光终点数laserendnum、线长dline、直线方程参数k1、直线方程参数k2、直线与激光传感器的距离dis。
优选地,判断是否与充电站的特征匹配的方法为:判断直线地图集合中的线长是否与充电站的长度阈值5匹配,如果不匹配,则在此时刻寻找激光失败。
优选地,所述判断是否与充电站的特征匹配的方法还可以为:根据直线地图集合InitialMap[i]中dLine与阈值6、InitialMap[i+1]中dLine与阈值7以及由InitialMap[i]中k1与InitialMap[i+1]中k1得到的两直线间角度与阈值8同时满足来判断是否为充电站;如果没有,则判断寻找充电站失败。
优选地,所述根据机器人在全局坐标系中的位姿进行与充电站的对接,包括:
机器人根据实时位姿与充电站前方的目标点进行距离偏差,角度偏差的计算;
判断机器人角度偏差是否小于阈值1;
当角度偏差大于阈值9时,机器人原地旋转180°并向后行走一段距离与充电站对接;
当角度偏差小于阈值9时,由增量式PID算法给出机器人的角速度,而线速度由角速度的反比来进行计算;
将机器人的线速度、角速度转化为电机转速发送给电机;进行与充电站的对接;
判断是否充电成功;
如果是,则充电完成;如果否,则重复此步骤。
本发明较现有技术,有如下方面的有益效果:
1、不仅仅可以提高机器人的续航能力,还可以保证人员与机器人本身的安全性。
2、目前的机器人充电由人工进行操作,机器人在空闲时段进行这无谓的电量损耗,不利于机器人长期运行,影响了机器人的作业能力。同时人工充电时如果充电口结构不合理或者端口老化,技术人员容易操作失误造成人或机器人的损伤。
3、通过本发明的方法,可以使机器人在空闲或者电量不足时自动寻找充电站并进行对接充电,提高了机器人的续能性与智能性。
4、采用激光的方法可以确保对接的准确性。
附图说明
图1是本发明充电方法整体流程图;
图2是本发明对接方法流程图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
参考图1所示,一种机器人自主充电方法,包括如下步骤:
S10:计算所有激光点在机器人坐标系中的坐标。
以机器人当前位置为原点,机器人当前航向为Y轴,以垂直于Y轴的方向为X轴建立机器人坐标系,在该坐标系中,以机器人当前位置为圆心,在机器人正前方270°范围内,每隔0.25°就有激光传感器打出的一个激光点,共计产生1081个激光点,即有1081个激光数据laserdata[i]。分别计算1081个激光点在机器人坐标系中的坐标。计算公式如下:
S20:取每三个激光点为一组,分别计算激光点之间的距离以及到激光传感器之间的距离。
得到激光点的坐标后,取每三个激光点为一组,分别计算三个激光点之间的距离dis1To2、dis2To3以及三个激光点的距离值dis1、dis2、dis3。
S30:判断是否对激光点进行点集分割。
根据上述每三个激光点之间的距离以及每三个激光点的距离值判断是否对激光点进行点集分割。开始分割的条件为:dis2>阈值1&&dis2To3<阈值2;结束直线分割的条件是dis1>阈值3&&dis1To2>阈值4。
不断重复步骤S20和S30,直到所有的激光点全部确定完是否分割。
S40:对可以分割的激光点进行分割,得到分组后的点集。
根据上述条件得到分组后的点集PointGroup[i]。
S50:将分组后的每组点集分割为两组,对每组点集进行最小二乘法的拟合,获得直线地图集合。
具体步骤为:
S501:对所得的点集PointGroup[i]中的激光点进行激光最小值/最大值的求取;
S502:以此点为截点将每组PointGroup[i]分割为两组新点集,并对得到的NewPointGroup[j]个点集进行基于最小二乘法的直线拟合。
S503:得到初始直线地图集合InitialMap[j],每条地图的信息包含直线的起点坐标x、起点坐标y、激光起始数laserstartnum、终点坐标x、终点坐标y、激光终点数laserendnum、线长dline、直线方程参数k1、直线方程参数k2、直线与激光传感器的距离dis等。
S60:根据点集与直线地图集合所包含的参数,判断是否与充电站的特征匹配。
判断直线地图集合InitialMap[i]中的dLine是否与充电站的长度阈值5匹配,如果没有,则在此时刻寻找充电站失败。
根据直线地图集合InitialMap[i]中dLine与阈值6、InitialMap[i+1]中dLine与阈值7以及由InitialMap[i]中k1与InitialMap[i+1]中k1得到的两直线间角度与阈值8同时满足来判断是否为充电站。如果没有,则判断寻找充电站失败。
S70:匹配的结果为只留有与充电站特征匹配的两条直线,根据两条直线方程以及充电站在全局坐标中的位置,,计算出机器人在全局坐标中的位姿。
假设机器人在全局坐标系中的坐标为(x0,y0)。假设充电站的角点坐标为(0,1800)。那么充电站两条特征直线在全局坐标中的直线方程为:
可以得到关于x0、y0的二元一次方程:
依据以上二元一次方程可以求的机器人在全局坐标系中的位姿(x0,y0)。
S80:根据机器人在全局坐标系中的位姿进行与充电站的对接。
如图2所示,对接方法为:
S801:机器人根据实时位姿与充电站前方的目标点进行距离偏差,角度偏差的计算;
S802:判断机器人角度偏差是否小于阈值9;
根据PID原理进行线速度及角速度的规划。机器人根据当前位姿信息(x,y,angle)以及目标点位置(xend,yend,angleend)计算机器人与目标的距离偏差与角度偏差。
S803:当角度偏差大于阈值9时,机器人原地旋转180°并向后行走一段距离与充电站对接;
机器人到达充电站前方40cm时停止,原地旋转180°,再向后运动40cm,如果机器人收到充电信号则继续充电,如果没有收到充电信号,则机器人向外行走2m后向后旋转180°再次进行充电站寻找操作。
S804:当角度偏差小于阈值9时,由增量式PID算法给出机器人的角速度,而线速度由角速度的反比来进行计算。
当小于阈值9时,根据增量式PID算法得到机器人的角速度W,V与W成反比。
S805:将机器人的线速度、角速度转化为电机转速发送给电机;进行与充电站的对接;
S806:判断是否充电成功;
S807:如果是,则充电完成;如果否,则返回步骤S801。
值得说明的是,本实施例中阈值1-阈值9的数据均为实际测量所确定。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求的保护范围为准。
Claims (7)
1.一种机器人自主充电方法,其特征在于:该方法包括如下步骤:
S10:计算所有激光点在机器人坐标系中的坐标;
S20:取每三个激光点为一组,分别计算激光点之间的距离以及到激光传感器之间的距离;
S30:判断是否对激光点进行点集分割;
S40:对可以分割的激光点进行分割,得到分组后的点集;
S50:将分组后的每组点集分割为两组,对每组点集进行最小二乘法的拟合,获得直线地图集合;
S60:根据点集与直线地图集合所包含的参数,判断是否与充电站的特征匹配;
S70:匹配的结果为只留有与充电站特征匹配的两条直线,根据两条直线方程以及充电站在全局坐标中的位置,计算出机器人在全局坐标中的位姿;
S80:根据机器人在全局坐标系中的位姿进行与充电站的对接;
所述将分组后的每组点集分割为两组,对每组点集进行最小二乘法的拟合,获得直线地图集合,具体方法为:
对所得的点集中的激光点到激光传感器的距离进行最小值或者最大值的求取;
以获取的距离最小值或者最大值对应的激光点为截点将每组点集分割为两组新点集,并对得到的新点集进行基于最小二乘法的直线拟合;
得到初始直线地图集合。
2.如权利要求1所述的一种机器人自主充电方法,其特征在于:在所述计算所有激光点在机器人坐标系中的坐标之前,先要建立机器人坐标系,具体为:以机器人当前位置为原点,机器人当前航向为Y轴,以垂直于Y轴的方向为X轴建立机器人坐标系。
3.如权利要求1所述的一种机器人自主充电方法,其特征在于:所述判断是否对激光点进行点集分割,条件为:dis2>阈值1&&dis2To3<阈值2;结束直线分割的条件是dis1>阈值3&&dis1To2>阈值4,其中&&为逻辑与,dis1为第一个激光点到激光传感器的距离值,dis2为第二个激光点到激光传感器的距离值,dis1To2为第一个激光点到第二个激光点的距离值,dis2To3为第二个激光点到第三个激光点的距离值。
4.如权利要求3所述的一种机器人自主充电方法,其特征在于:每条直线地图的信息都包含直线的起点坐标x、起点坐标y、激光起始数laserstartnum、终点坐标x、终点坐标y、激光终点数laserendnum、线长dline、直线方程参数k1、直线方程参数k2、直线与激光传感器的距离dis。
5.如权利要求4所述的一种机器人自主充电方法,其特征在于:所述判断是否与充电站的特征匹配的方法为:判断直线地图集合中的线长是否与充电站的长度阈值5匹配,如果不匹配,则判断寻找充电站失败。
6.如权利要求4所述的一种机器人自主充电方法,其特征在于:所述判断是否与充电站的特征匹配的方法为:根据直线地图集合InitialMap[i]中dLine与阈值6、InitialMap[i+1]中dLine与阈值7以及由InitialMap[i]中k1与InitialMap[i+1]中k1得到的两直线间角度与阈值8同时满足来判断是否为充电站;如果没有,则判断寻找充电站失败。
7.如权利要求1所述的一种机器人自主充电方法,其特征在于:所述根据机器人在全局坐标系中的位姿进行与充电站的对接,包括:
机器人根据实时位姿与充电站前方的目标点进行距离偏差,角度偏差的计算;
判断机器人角度偏差是否小于阈值9;
当角度偏差大于阈值9时,机器人原地旋转180°并向后行走一段距离与充电站对接;
当角度偏差小于阈值9时,由增量式PID算法给出机器人的角速度,而线速度由角速度的反比来进行计算;
将机器人的线速度、角速度转化为电机转速发送给电机;进行与充电站的对接;
判断是否充电成功;
如果是,则充电完成;如果否,则重复此步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310574088.3A CN104635730B (zh) | 2013-11-13 | 2013-11-13 | 一种机器人自主充电方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310574088.3A CN104635730B (zh) | 2013-11-13 | 2013-11-13 | 一种机器人自主充电方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104635730A CN104635730A (zh) | 2015-05-20 |
CN104635730B true CN104635730B (zh) | 2017-07-28 |
Family
ID=53214599
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310574088.3A Active CN104635730B (zh) | 2013-11-13 | 2013-11-13 | 一种机器人自主充电方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104635730B (zh) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108431713B (zh) * | 2015-12-30 | 2022-08-26 | 意大利电信股份公司 | 用于给移动机器人充电的对接系统和方法 |
CN106020188B (zh) * | 2016-05-17 | 2018-10-30 | 杭州申昊科技股份有限公司 | 一种基于激光导航的变电站巡检机器人自主充电方法 |
CN106444777B (zh) * | 2016-10-28 | 2019-12-17 | 北京进化者机器人科技有限公司 | 机器人自动回位充电方法和系统 |
CN106786938B (zh) * | 2016-12-30 | 2020-03-20 | 亿嘉和科技股份有限公司 | 一种巡检机器人定位方法及自动充电方法 |
CN107608358A (zh) * | 2017-09-30 | 2018-01-19 | 爱啃萝卜机器人技术(深圳)有限责任公司 | 基于轮廓识别技术的高效率低成本自动回充系统和方法 |
CN107992054A (zh) * | 2017-12-17 | 2018-05-04 | 上海物景智能科技有限公司 | 一种机器人的定位的方法及系统 |
CN108646729A (zh) * | 2018-04-12 | 2018-10-12 | 深圳先进技术研究院 | 一种机器人及其路径规划方法、机器人系统 |
CN109116851B (zh) * | 2018-09-05 | 2021-09-10 | 南京理工大学 | 一种基于地图切换的巡检机器人进出库算法 |
CN109141402B (zh) * | 2018-09-26 | 2021-02-02 | 亿嘉和科技股份有限公司 | 一种基于激光栅格的定位方法以及机器人自主充电方法 |
CN109752730B (zh) * | 2019-02-25 | 2024-02-27 | 佛山市奇创自动化设备有限公司 | 一种基于v槽检测的激光定位方法及系统 |
CN111267104B (zh) * | 2020-03-10 | 2021-07-02 | 上海高仙自动化科技发展有限公司 | 位姿标定方法、机器人、电子设备和可读存储介质 |
CN111552290B (zh) * | 2020-04-30 | 2023-09-05 | 珠海一微半导体股份有限公司 | 一种机器人沿墙找直线的方法及清扫方法 |
CN112928799B (zh) * | 2021-02-04 | 2022-08-09 | 北京工业大学 | 基于激光测量的移动机器人自动对接充电方法 |
CN112947440B (zh) * | 2021-02-06 | 2024-09-06 | 七腾机器人有限公司 | 一种机器人自动充电的充电座搜寻方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101923352A (zh) * | 2010-07-05 | 2010-12-22 | 东南大学 | 具有自动返回充电座功能的室内安保机器人及返回方法 |
CN201956729U (zh) * | 2010-12-24 | 2011-08-31 | 深圳市银星智能电器有限公司 | 基于无线网络的移动机器人用充电系统 |
CN102437601A (zh) * | 2011-10-21 | 2012-05-02 | 中国科学院苏州纳米技术与纳米仿生研究所 | 云机器人自主充电系统及方法 |
CN103066645A (zh) * | 2012-12-14 | 2013-04-24 | 安科智慧城市技术(中国)有限公司 | 一种机器人及其自动充电系统和方法 |
CN103054522A (zh) * | 2012-12-31 | 2013-04-24 | 河海大学 | 基于视觉测量的清洁机器人系统及其测控方法 |
CN103251354A (zh) * | 2012-02-16 | 2013-08-21 | 恩斯迈电子(深圳)有限公司 | 扫地机器人的控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8972052B2 (en) * | 2004-07-07 | 2015-03-03 | Irobot Corporation | Celestial navigation system for an autonomous vehicle |
KR101672787B1 (ko) * | 2009-06-19 | 2016-11-17 | 삼성전자주식회사 | 로봇청소기와 도킹스테이션 및 이를 가지는 로봇청소기 시스템 및 그 제어방법 |
-
2013
- 2013-11-13 CN CN201310574088.3A patent/CN104635730B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101923352A (zh) * | 2010-07-05 | 2010-12-22 | 东南大学 | 具有自动返回充电座功能的室内安保机器人及返回方法 |
CN201956729U (zh) * | 2010-12-24 | 2011-08-31 | 深圳市银星智能电器有限公司 | 基于无线网络的移动机器人用充电系统 |
CN102437601A (zh) * | 2011-10-21 | 2012-05-02 | 中国科学院苏州纳米技术与纳米仿生研究所 | 云机器人自主充电系统及方法 |
CN103251354A (zh) * | 2012-02-16 | 2013-08-21 | 恩斯迈电子(深圳)有限公司 | 扫地机器人的控制方法 |
CN103066645A (zh) * | 2012-12-14 | 2013-04-24 | 安科智慧城市技术(中国)有限公司 | 一种机器人及其自动充电系统和方法 |
CN103054522A (zh) * | 2012-12-31 | 2013-04-24 | 河海大学 | 基于视觉测量的清洁机器人系统及其测控方法 |
Non-Patent Citations (1)
Title |
---|
室内自主移动机器人的定位研究;于克;《中国优秀硕士学位论文全文数据库 信息科技辑》;20100715(第07期);第I140-247页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104635730A (zh) | 2015-05-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104635730B (zh) | 一种机器人自主充电方法 | |
CN207718228U (zh) | 一种可靠的室内全向移动机器人自主充电系统 | |
CN108594822A (zh) | 基于二维码的机器人定位方法、机器人充电方法及系统 | |
CN103353758B (zh) | 一种室内机器人导航方法 | |
CN103592944B (zh) | 一种超市购物机器人及其行进路径规划方法 | |
CN110018686A (zh) | 一种智能割草机的路径规划方法 | |
CN112928799B (zh) | 基于激光测量的移动机器人自动对接充电方法 | |
CN113189977B (zh) | 一种用于机器人的智能导航路径规划系统及方法 | |
CN109460032A (zh) | 一种基于激光对射的定位方法以及机器人自主充电方法 | |
CN104914866A (zh) | 基于拓扑点分类的巡检机器人全局路径规划方法及系统 | |
CN106786938A (zh) | 一种巡检机器人定位方法及自动充电方法 | |
CN205121338U (zh) | 基于图像识别与无线网络的agv导航系统 | |
CN109828558A (zh) | 一种智能运动系统及方法 | |
CN111090284B (zh) | 自行走设备返回基站的方法及自行走设备 | |
CN107607093A (zh) | 一种基于无人艇的湖泊动态库容的监测方法及装置 | |
CN108627171A (zh) | 基于无线信号强度梯度的移动机器人定位充电基座的智能方法 | |
KR20170023782A (ko) | 측위 평면에서 로봇의 위치를 찾기 위한 방법 | |
US11927964B2 (en) | Autonomous work machine, method of controlling the same, and storage medium | |
CN108536146B (zh) | 基于路径和rssi的移动机器人定位充电基座的智能控制方法 | |
CN208126205U (zh) | 一种自动避障的无人飞行装置 | |
Romanov et al. | An automatic docking system for wheeled mobile robots | |
Zhang et al. | Automatic docking and charging of mobile robot based on laser measurement | |
CN105004368A (zh) | 一种自主机器人的碰撞检测方法、装置及系统 | |
CN108646740A (zh) | 基于双无线网络的移动机器人回归路径规划方法 | |
CN108762254A (zh) | 基于无线信号强度变化的移动机器人回归路径规划方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |