CN110221617B - 机器人充电座、机器人自动回充系统及自动回充方法 - Google Patents
机器人充电座、机器人自动回充系统及自动回充方法 Download PDFInfo
- Publication number
- CN110221617B CN110221617B CN201910639957.3A CN201910639957A CN110221617B CN 110221617 B CN110221617 B CN 110221617B CN 201910639957 A CN201910639957 A CN 201910639957A CN 110221617 B CN110221617 B CN 110221617B
- Authority
- CN
- China
- Prior art keywords
- robot
- scanning
- calculating
- data
- preset value
- 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
- 238000000034 method Methods 0.000 title claims abstract description 28
- 239000004020 conductor Substances 0.000 claims abstract description 26
- 230000007704 transition Effects 0.000 claims description 14
- 238000007781 pre-processing Methods 0.000 claims description 6
- 210000001503 joint Anatomy 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 6
- 239000011159 matrix material Substances 0.000 description 4
- 239000011358 absorbing material Substances 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 230000009466 transformation Effects 0.000 description 3
- RYGMFSIKBFXOCR-UHFFFAOYSA-N Copper Chemical compound [Cu] RYGMFSIKBFXOCR-UHFFFAOYSA-N 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 229910052802 copper Inorganic materials 0.000 description 2
- 239000010949 copper Substances 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000011065 in-situ storage Methods 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 229910052751 metal Inorganic materials 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000002310 reflectometry Methods 0.000 description 1
- 238000000844 transformation Methods 0.000 description 1
- 230000017105 transposition Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0225—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02J—CIRCUIT ARRANGEMENTS OR SYSTEMS FOR SUPPLYING OR DISTRIBUTING ELECTRIC POWER; SYSTEMS FOR STORING ELECTRIC ENERGY
- H02J7/00—Circuit arrangements for charging or depolarising batteries or for supplying loads from batteries
- H02J7/0042—Circuit arrangements for charging or depolarising batteries or for supplying loads from batteries characterised by the mechanical construction
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Power Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种机器人充电座、机器人自动回充系统及自动回充方法,其中,机器人充电座包括座体、电能输出导体、电源单元、标识区,电能输出导体安装在座体上,且其具有外露部分;电源单元内置于座体,且其与电能输出导体电连接;标识区设置在座体上,包括若干强反射区与若干弱反射区,强反射区与弱反射区两者依次间隔设置。本发明的机器人充电座、机器人自动回充系统及自动回充方法通过在机器人充电座上设置特殊结构的标识区,使得机器人只需要依赖自身的激光雷达即可实现自动回充,无需添加额外的传感器来实现自动回充,且扩大了机器人可以进行回充的范围;同时使用激光雷达反馈的强度和距离信息对标识区进行识别,提高了识别的准确率。
Description
技术领域
本发明涉及机器人技术领域,特别是涉及一种机器人充电座、机器人自动回充系统及自动回充方法。
背景技术
目前机器人自动回充,较多的是利用红外传感器实现,这需要在充电桩和机器人上分别安装红外接收和发射装置,对已配有激光雷达的机器人来说,增加了结构成本,且红外传感器易受环境干扰,适用范围有限。
发明内容
发明目的:为了克服现有技术中存在的不足,本发明提供一种机器人充电座、机器人自动回充系统及自动回充方法,旨在解决现有充电座及机器人自动回充系统结构成本高及无法远距离使用的问题。
技术方案:为实现上述目的,本发明的机器人充电座,包括:
座体;
电能输出导体,其安装在所述座体上,且其具有外露部分;
电源单元,其内置于所述座体,且其与所述电能输出导体电连接;及
标识区,其设置在所述座体上,包括若干强反射区与若干弱反射区,所述强反射区与弱反射区两者依次间隔设置。
进一步地,所述强反射区由贴在所述座体上的激光反射板形成。
进一步地,所述弱反射区由贴在所述座体上的吸光材料形成。
进一步地,所述座体上具有若干凹陷部,每个所述凹陷部的底部均设置为强反射区。
机器人自动回充系统,包括上述的机器人充电座以及机器人,所述机器人包括可移动底盘、激光雷达、控制单元、电源及充电触片,所述充电触片与所述电源电连接。
机器人自动回充方法,应用于机器人自动回充系统中机器人的控制单元,所述控制单元至少包括处理器与存储器,所述方法包括:
利用激光雷达扫描周围环境获取一帧扫描数据,根据所述扫描数据判断是否扫描到了标识区;
当扫描到了标识区,根据所述扫描数据计算机器人充电座的计算位置,并根据所述计算位置计算位于所述机器人充电座的特定方位的过渡点位的坐标;
控制所述可移动底盘运动,使所述机器人整体运动至所述过渡点位;
利用激光雷达扫描,计算并判断所述标识区是否位于所述计算位置处;
当标识区位于所述计算位置处,控制所述可移动底盘向所述机器人充电座运动,使所述充电触片与所述电能输出导体对接。
进一步地,所述存储器内至少存储有第一预定值、第二预定值、第三预定值、第四预定值及第五预定值;所述第四预定值为第一个强反射区的首端至最后一个强反射区的尾端的总距离;
所述根据所述扫描数据判断是否扫描到了标识区包括:
对所述扫描数据进行预处理,剔除其中强度值小于第一预定值的扫描点的数据,得到第一数据组;
计算第一数据组中每相邻两个扫描点之间的距离,并判断各距离是否超过第二预定值,若超过,将该距离对应的扫描点记为分割点;
利用所述分割点将所述第一数据组分割为若干子数据组,去掉数量少于第三预定值的子数据组;
计算剩余每个子数据组首尾两个扫描点之间的线段的长度,剔除长度超过第四预定值的线段;
计算剩余线段中相邻线段的间距,对间距小于第五预定值的两个线段进行合并,计算合并后线段的总长;
在最终所得线段中,判断是否存在线段的长度与所述第四预定值的差值百分比在设定范围内,是则说明扫描到了标识区,该线段为标识线段;否则说明未扫描到标识区。
进一步地,所述根据所述扫描数据计算机器人充电座的计算位置,并根据所述计算位置计算位于所述机器人充电座的特定方位的过渡点位的坐标包括:
根据确立所述标识线段的子数据组的扫描点的坐标,在所述激光雷达的坐标系下拟合得到一条直线,并计算所述标识区正前方设定距离处的过渡点位的坐标。
进一步地,所述存储器内还存储有第六预定值、第七预定值及第八预定值;所述利用激光雷达扫描,计算并判断所述标识区是否位于所述计算位置处包括:
利用激光雷达扫描机器人前方一定角度获取一帧扫描数据;
对所述扫描数据进行预处理,剔除其中信号强度小于第一预定值的扫描点的数据,得到第二数据组;
计算第二数据组中每相邻两个扫描点之间的距离,并判断各距离是否超过第六预定值,若超过,将该距离对应的扫描点记为分割点;
利用所述分割点将所述第一数据组分割为若干分数据组,剔除数量少于第七预定值的分数据组;
计算剩余每组分数据组首尾两个扫描点之间的线段的长度,剔除其中算得线段长度大于第八预定值的分数据组;
计算剩余每组分数据组对应线段之间的间距,判断剩余线段中是否存在若干线段的长度及间距的排列规律与所述标识区的强反射区与弱反射区的宽度排列规律契合;若存在,这些线段为匹配线段。
进一步地,所述强反射区与弱反射区不在同一平面;所述方法还包括:
从所述匹配线段对应的扫描点之间被剔除的扫描点中选取若干扫描点,判断选取的扫描点到所述匹配线段的距离是否与所述强反射区与弱反射区之间的距离相符;
是则说明所述机器人充电座位于所述计算位置处。
有益效果:本发明的机器人充电座、机器人自动回充系统及自动回充方法通过在机器人充电座上设置特殊结构的标识区,使得机器人只需要依赖自身的激光雷达即可实现自动回充,无需添加额外的传感器来实现自动回充;自动回充方法分两个阶段对标识区进行识别,当距离较远时也能识别到标识区,扩大了机器人可以进行回充的范围;同时使用激光雷达反馈的强度和距离信息对标识区进行识别,提高了识别的准确率。
附图说明
附图1为机器人充电座的结构图;
附图2为机器人充电座的侧视图;
附图3为带有红外透光片的机器人充电座的外形图;
附图4为电能输出导体与座体之间的连接结构图;
附图5为标识区处各反射区的宽度标示图;
附图6为机器人的结构图;
附图7为机器人坐标系及激光雷达坐标系两个坐标系的示意图;
附图8为机器人自动回充方法的流程示意图;
附图9为激光扫描结果示意图。
附图中各附图标记表示的零部件名称如下:
1-机器人充电座;11-座体;12-电能输出导体;13-电源连接口;14-标识区;141-强反射区;142-弱反射区;15-红外透光片;2-机器人;21-移动底盘;22-激光雷达;23-控制单元;24-充电触片。
具体实施方式
下面结合附图对本发明作更进一步的说明。
如附图1所示的机器人充电座,包括座体11、电能输出导体12、电源单元以及标识区14:其中电能输出导体12安装在所述座体11上,且其具有外露部分;电源单元内置于所述座体11,且其与所述电能输出导体12电连接,需要充电的机器人上配套设置有电能输入导体,机器人需要充电时运动到位,使得电能输入导体与电能输出导体12接触,即可进行充电。本实施例中,电能输出导体12为铜块。电源单元主要实现电能功率及交直流转换,并可实现短路保护,市面上这种类型的电源单元较为常见,可使用现有产品,本发明在此不对电源单元的具体电路作说明。
如附图2所示,座体11上安装有外露的电源连接口13,电源连接口13可连接带有插头的电源线,且电源连接口13电连接所述电源单元。
标识区14设置在所述座体11上,包括若干强反射区141与若干弱反射区142,所述强反射区141与弱反射区142两者依次间隔设置,即每两个相邻的强反射区141之间均设置有一个弱反射区142,且每两个相邻的弱反射区142之间均设置有一个强反射区141。优选地,所述强反射区141由贴在所述座体11上的激光反射板形成,激光反射板对激光具有较强的反射作用,激光雷达扫描激光反射板时收到的反馈信号的强度远大于扫描一般物体时收到的反馈信号的强度。所述弱反射区142可以是普通材料表面(弱反射区142自身的外表面,或者在座体11上对应于弱反射区142的位置贴普通的标识材料),但优选地,弱反射区142可以由贴在所述座体11上的吸光材料形成,吸光材料对激光的反射率较低,激光雷达扫描后收到的返回信号的强度会低于一般物体。如此,通过对标识区14进行特殊设计,使得标识区14反馈的信号强度明显区别于一般物体反馈的信号的强度,使得机器人寻找充电座时容易确定目标。
本实施例中,弱反射区142的数量为3个,强反射区141的数量为2个,即标识区14的两端为两个弱反射区142,中间为强、弱、强的布局。如图5所示,三个弱反射区142的宽度从左到右依次为D0、D1与D2,两个强反射区141的宽度从左到右依次为L0与L1。此外,为了方便机器人对激光雷达扫描的数据进行处理与识别,此处D0、D1与D2三个数值各不相等,L0与L1也不相等。
所述座体11上具有若干凹陷部111,每个所述凹陷部111的底部均设置为强反射区141,即:对应于每个强反射区141的位置座体11上均设置有凹陷部111,这样标识区14不仅具有反馈信号强度有别于一般物体的特征,而且还具有凹凸特征,可方便机器人寻找充电座时对充电座进行进一步确认。此处,凹陷部111的深度即为W,即强反射区141与弱反射区142之间的平面距离为W。
优选地,如附图3所示,标识区14上覆盖有红外透光片15,红外透光片15可保护标识区14,并使得充电座整体的外观较为美观。
为了使得机器人上的电能输入导体与电能输出导体12之间可以有效接触,所述电能输出导体12可相对于座体11弹性浮动。如附图4为一种可实现电能输出导体12相对于座体11弹性浮动的结构,其中电能输出导体12与座体11滑动连接,且电能输出导体12后侧与座体11之间设置有弹簧。
本发明还提供了一种机器人自动回充系统,包括上述的机器人充电座1以及机器人2。如附图7所示,所述机器人2包括可移动底盘21、激光雷达22、控制单元23、电源及充电触片24,所述充电触片24与所述电源电连接。其中,可移动底盘21具有两个主动轮,每个主动轮均具有驱动电机,驱动电机与激光雷达22均与控制单元23电性连接,控制单元23可通过激光雷达22扫描周围环境采集环境数据,且可驱动两个驱动电机作差速转动,实现可移动底盘21的前进、后退、转弯等运动。电源用于为整个机器人2供电,充电触片24即上述的电能输入导体,充电触片24为金属铜片。此外,为了保护电源,可在充电触片24与所述电源之间设置保护电路,保护电路可监测充电电流,若出现过流过载的情形,可及时切断充电电路,以保护电池,此处保护电路为现有技术,也有成熟产品可以购买,由于其不是本发明的创新核心内容,此处不对其作具有说明。
本发明还提供了一种机器人自动回充方法,应用于机器人自动回充系统中机器人2的控制单元23,所述控制单元23至少包括处理器与存储器,存储器内存储有可执行程序,处理器执行存储器内的可执行程序以实现下列自动回充方法。
首先,需要说明的是,本发明的自动回充方法涉及两个直角坐标系,即机器人坐标系OrXrYr和激光雷达坐标系OlXlYl;如附图7所示,机器人坐标系原点位于机器人旋转中心,Xr为机器人运动的正方向,Yr指向机器人左方(符合右手直角坐标系);Ol位于激光雷达测量中心,Xl指向激光雷达正方向。激光雷达坐标系到机器人坐标系的变换矩阵为T(2×2矩阵,已知量,根据机械设计图纸或者实际测量获得),即一般情况下,激光雷达安装在机器人前方,两个坐标系的指向一致(此时T表示平移变换),如图7所示,此外,指向不一致(T包含平移和旋转变换)时本专利方法同样适用。
激光雷达扫描周边环境后,得到的扫描点反馈的数据以(li,θi,si)表示,其中0≤i<n,n是激光雷达扫描一周可以获取的数据数目,l为测量距离,θ是该次测量与雷达正方向(激光雷达出厂设置规定的正方向)的夹角,s是返回的信号强度。
数据(li,θi,si)通过如下公式转换到激光雷达坐标系:
xi=li·cosθi
yi=li·sinθi
如附图8所示,本发明的机器人自动回充方法包括如下步骤S301-S305:
步骤S301,利用激光雷达22扫描周围环境获取一帧扫描数据,根据所述扫描数据判断是否扫描到了标识区14;若扫描到了标识区14,转至步骤302;若未扫描到标识区14,使可移动底盘21移动位置并重新扫描,直至扫描到标识区14;
本步骤中,控制单元23利用激光雷达22扫描数据的方法为:控制可移动底盘21原地旋转一周,激光雷达22以设定频率发出激光并接收物体的反馈信号,如此可移动底盘21旋转一周后激光雷达22扫描得到了若干扫描点的坐标信息与反馈的激光信号强度信息。基于扫描数据进行计算可判断是否存在满足标识区14反射信号特征的数据,从而判断出是否扫描到标识区14,若判断出激光雷达22未扫描到标识区14,则说明机器人2与机器人充电座1之间距离存在障碍物。此外,在其他实施例中,如果机器人2具有自动导航功能,机器人2可先运动到一预设点位,再进行扫描,但预设点位与机器人充电座1之间也有可能存在障碍物,因此也有扫描不到标识区14的可能,当扫描不到标识区14,机器人2换位扫描直至扫描到标识区14为止。
步骤S302,根据所述扫描数据计算机器人充电座1的计算位置,并根据所述计算位置计算位于所述机器人充电座1的特定方位的过渡点位的坐标;
步骤S303,控制所述可移动底盘21运动,使所述机器人2整体运动至所述过渡点位;
步骤S304,利用激光雷达22扫描,计算并判断所述标识区14是否位于所述计算位置处;若判断出所述标识区14确实位于所述计算位置处,进入步骤S305;
本步骤用于再次确认充电座的位置,由于之前通过远距离扫描算出的计算位置与过渡点位可能有错误,因此,此处通过二次扫描计算可判断充电座是否确实在计算位置。若判断出所述标识区14不在所述计算位置处,说明之前的计算存在失误,需要整个流程重新开始。
步骤S305,控制所述可移动底盘21向所述机器人充电座1运动,使所述充电触片24与所述电能输出导体12对接。
具体地,所述存储器内至少存储有第一预定值、第二预定值、第三预定值、第四预定值及第五预定值;所述第四预定值为第一个强反射区141的首端至最后一个强反射区141的尾端的总距离;具体到本实施例中,上述第四预定值的值即为L0+L1+D1。
基于此,上述步骤S301中根据所述扫描数据判断是否扫描到了标识区14包括如下步骤S401-S406:
步骤S401,对所述扫描数据进行预处理,剔除其中强度值小于第一预定值的扫描点的数据,得到第一数据组;
具体到本实施例中,第一预定值为一强度数值,其值可定为S0,S0大于一般物体的反射强度,但稍小于反射板反射强度,如此,可剔除掉大部分扫描点,只留下若干强度值满足条件的扫描点,且这些扫描点一般是分段聚集的。将剩下的扫描点的数据索引i存入数组v中,数组v即为本步骤中的第一数据组,当然,此处仅为第一数据组的一种形式,其还可以直接是所有扫描点的数据的集合。
步骤S402,计算第一数据组中每相邻两个扫描点之间的距离,并判断各距离是否超过第二预定值,若超过,将该距离对应的扫描点记为分割点;
具体到本实施例中,控制单元23依次计算数组v中每相邻两个数据索引所对应的扫描点之间的间距Δd,如第j个扫描点与第j+1个扫描点之间的距离为其中,0≤j≤k,k为预处理后扫描点的数目。若Δd大于第二预定值,说明这两个点之间距离较大,在空间上不是连续的点,则记下此时的索引值v[j],将该值记为一个分割点。
步骤S403,利用所述分割点将所述第一数据组分割为若干子数据组,去掉数量少于第三预定值的子数据组;
具体到本实施例中,若有m个分割点,则第一数据组v被分割为m+1个子数据组,判断每个子数据组中包含数据的个数,若子数据组中数据个数太少(如只有一个独立的扫描点),少于第三预定值,则说明该子数据组对应的扫描点不可能是标识区14的扫描点,可以将其剔除以节省后续工作量,此处第三预定值的数值大于等于2。
步骤S404,计算剩余每个子数据组首尾两个扫描点之间的线段的长度,剔除长度超过第四预定值的线段;
具体到本实施例中,同一子数据组中的数据由于在空间上是连续的,说明他们来自同一反射面,计算子数据组首尾两个扫描点之间的线段距离即可大概计算出该反射面的宽度数据。若根据单一子数据组计算出的线段长度大于L0+L1+D1(即第四预定值),说明该子数据组明显不是标识区14的扫描点对应的线段,可以直接剔除。
步骤S405,计算剩余线段中相邻线段的间距,对间距小于第五预定值的两个线段进行合并,计算合并后线段的总长;
具体到本实施例中,若算得的两个线段之间的间距小于第五预定值,第五预定值稍大于D1(如第五预定值可以是D1与1.2倍D1之间的某一数值),即说明此两个线段之间的间距较近,可能是标识区14中的扫描点组成的线段,因此将两个线段进行合并计算,注意,此处合并计算的方法是,计算第一个子数据组最前端扫描点到第二个子数据组最后端扫描点之间的线段的长度,而不是将两者形成的线段长度相加。
步骤S406,在最终所得线段中,判断是否存在线段的长度与所述第四预定值的差值百分比在设定范围内,是则说明扫描到了标识区14,该线段为标识线段;否则说明未扫描到标识区14。
具体到本实施例中,此步骤即判断最终所得的线段中是否有线段长度与L0+L1+D1这一数值相接近,是则可初步确定扫描到了标识区14。
进一步地,上述步骤S302具体为:根据确立所述标识线段的子数据组的扫描点的坐标,在所述激光雷达22的坐标系下拟合得到一条直线,并计算所述标识区14正前方设定距离处(如q米)的过渡点位的坐标。
具体地,在本实施例中,过渡点位为P点。若最终确立所述标识线段的子数据组的扫描点有h个,各点的坐标为(xi,yi),采用整体最小二乘法求合的直线ax+by+c=0,其中a2+b2=1。a、b是矩阵的最小特征值所对应的特征向量,c可根据a、b获取,/>矩阵元素为点集的二阶中心距,如下所示。
求点P的坐标可得两个值其中λ=±q,取距原点近的值作为P的坐标。
具体地,所述存储器内还存储有第六预定值、第七预定值及第八预定值;所述利用激光雷达22扫描,步骤S304中计算并判断所述标识区14是否位于所述计算位置处包括如下步骤S501-S506:
步骤S501,利用激光雷达22扫描机器人2前方一定角度获取一帧扫描数据;
在上述步骤S303中,控制单元23控制机器人2到达过渡点位P点后,可进一步使机器人2的激光雷达22正对充电座的计算位置,这样本步骤中,只需要扫描机器人2正前方一定角度就可以进行判断,无需扫描一周,如附图9所示,图中θ为扫描角度,θ1为扫描步距,即每隔θ1的角度采集一个扫描点获取扫描点的反馈数据。本步骤中扫描得到的数据的类型与上述步骤S301中类似,此处不多赘述。
步骤S502,对所述扫描数据进行预处理,剔除其中信号强度小于第一预定值的扫描点的数据,得到第二数据组;
步骤S503,计算第二数据组中每相邻两个扫描点之间的距离,并判断各距离是否超过第六预定值,若超过,将该距离对应的扫描点记为分割点;
步骤S504,利用所述分割点将所述第一数据组分割为若干分数据组,剔除数量少于第七预定值的分数据组;
上述步骤S502-S504与前述步骤S401-S403类似,此处不多赘述。
步骤S505,计算剩余每组分数据组首尾两个扫描点之间的线段的长度,剔除其中算得线段长度大于第八预定值的分数据组;
具体到本实施例中,本步骤中剔除长度大于L0和L1的数据组。
步骤S506,计算剩余每组分数据组对应线段之间的间距,判断剩余线段中是否存在若干线段的长度及间距的排列规律与所述标识区14的强反射区141与弱反射区142的宽度排列规律契合;若存在,这些线段为匹配线段。
具体到本实施例中,若经过步骤S505剩余的线段有n个(正常情况下n=2),每个线段的长度leni及相邻两条线段的间距disi,取与信标长度L0,L1、信标间隔dis0相匹配的一组数据,匹配度根据式1获取,F越小,匹配度越高,当匹配度足够高,得到的两个线段即可确认是对应于两个强反射区141的线段,如此可确定标识区14在计算位置。匹配度的计算公式如下:
进一步地,由于所述强反射区141与弱反射区142不在同一平面,可以利用此特征对充电座进行进一步确认,具体方法为:从所述匹配线段对应的扫描点之间被剔除的扫描点中选取若干扫描点,判断选取的扫描点到所述匹配线段的距离是否与所述强反射区141与弱反射区142之间的距离相符;是则说明所述机器人充电座1位于所述计算位置处。
具体到本实施例中,上述匹配线段对应的扫描点之间被剔除的扫描点即对应于宽度为D1的弱反射区142的扫描点,从这些扫描点中选取若干扫描点并计算选取的扫描点到上述匹配线段的距离w(如附图9所示),并与强反射区141与弱反射区142之间的实际距离W对比,判断两者的差值比例是否小于特定值,若是,则进一步确认了充电座1位于所述计算位置处。
以上所述仅是本发明的优选实施方式,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。
Claims (4)
1.机器人自动回充方法,其特征在于,应用于机器人自动回充系统中机器人的控制单元;
所述机器人自动回充系统还包括机器人充电座,所述机器人包括可移动底盘、激光雷达、控制单元、电源及充电触片,所述充电触片与所述电源电连接;
所述机器人充电座包括:
座体;
电能输出导体,其安装在所述座体上,且其具有外露部分;
电源单元,其内置于所述座体,且其与所述电能输出导体电连接;及
标识区,其设置在所述座体上,包括若干强反射区与若干弱反射区,所述强反射区与弱反射区两者依次间隔设置;
所述控制单元至少包括处理器与存储器,所述方法包括:
利用激光雷达扫描周围环境获取一帧扫描数据,根据所述扫描数据判断是否扫描到了标识区;
当扫描到了标识区,根据所述扫描数据计算机器人充电座的计算位置,并根据所述计算位置计算位于所述机器人充电座的特定方位的过渡点位的坐标;
控制所述可移动底盘运动,使所述机器人整体运动至所述过渡点位;
利用激光雷达扫描,计算并判断所述标识区是否位于所述计算位置处;
当标识区位于所述计算位置处,控制所述可移动底盘向所述机器人充电座运动,使所述充电触片与所述电能输出导体对接;
所述存储器内至少存储有第一预定值、第二预定值、第三预定值、第四预定值及第五预定值;所述第四预定值为第一个强反射区的首端至最后一个强反射区的尾端的总距离;
所述根据所述扫描数据判断是否扫描到了标识区包括:
对所述扫描数据进行预处理,剔除其中强度值小于第一预定值的扫描点的数据,得到第一数据组;
计算第一数据组中每相邻两个扫描点之间的距离,并判断各距离是否超过第二预定值,若超过,将该距离对应的扫描点记为分割点;
利用所述分割点将所述第一数据组分割为若干子数据组,去掉数量少于第三预定值的子数据组;
计算剩余每个子数据组首尾两个扫描点之间的线段的长度,剔除长度超过第四预定值的线段;
计算剩余线段中相邻线段的间距,对间距小于第五预定值的两个线段进行合并,计算合并后线段的总长;
在最终所得线段中,判断是否存在线段的长度与所述第四预定值的差值百分比在设定范围内,是则说明扫描到了标识区,该线段为标识线段;否则说明未扫描到标识区。
2.由权利要求1所述的机器人自动回充方法,其特征在于,所述根据所述扫描数据计算机器人充电座的计算位置,并根据所述计算位置计算位于所述机器人充电座的特定方位的过渡点位的坐标包括:
根据确立所述标识线段的子数据组的扫描点的坐标,在所述激光雷达的坐标系下拟合得到一条直线,并计算所述标识区正前方设定距离处的过渡点位的坐标。
3.由权利要求2所述的机器人自动回充方法,其特征在于,所述存储器内还存储有第六预定值、第七预定值及第八预定值;所述利用激光雷达扫描,计算并判断所述标识区是否位于所述计算位置处包括:
利用激光雷达扫描机器人前方一定角度获取一帧扫描数据;
对所述扫描数据进行预处理,剔除其中信号强度小于第一预定值的扫描点的数据,得到第二数据组;
计算第二数据组中每相邻两个扫描点之间的距离,并判断各距离是否超过第六预定值,若超过,将该距离对应的扫描点记为分割点;
利用所述分割点将所述第一数据组分割为若干分数据组,剔除数量少于第七预定值的分数据组;
计算剩余每组分数据组首尾两个扫描点之间的线段的长度,剔除其中算得线段长度大于第八预定值的分数据组;
计算剩余每组分数据组对应线段之间的间距,判断剩余线段中是否存在若干线段的长度及间距的排列规律与所述标识区的强反射区与弱反射区的宽度排列规律契合;若存在,这些线段为匹配线段。
4.由权利要求3所述的机器人自动回充方法,其特征在于,所述强反射区与弱反射区不在同一平面;所述方法还包括:
从所述匹配线段对应的扫描点之间被剔除的扫描点中选取若干扫描点,判断选取的扫描点到所述匹配线段的距离是否与所述强反射区与弱反射区之间的距离相符;
是则说明所述机器人充电座位于所述计算位置处。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910639957.3A CN110221617B (zh) | 2019-07-16 | 2019-07-16 | 机器人充电座、机器人自动回充系统及自动回充方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910639957.3A CN110221617B (zh) | 2019-07-16 | 2019-07-16 | 机器人充电座、机器人自动回充系统及自动回充方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110221617A CN110221617A (zh) | 2019-09-10 |
CN110221617B true CN110221617B (zh) | 2024-03-08 |
Family
ID=67812518
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910639957.3A Active CN110221617B (zh) | 2019-07-16 | 2019-07-16 | 机器人充电座、机器人自动回充系统及自动回充方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110221617B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110543178A (zh) * | 2019-09-30 | 2019-12-06 | 深圳市银星智能科技股份有限公司 | 一种机器人回充方法及其系统、机器人及充电站 |
CN110596716B (zh) * | 2019-10-11 | 2021-10-01 | 劢微机器人科技(深圳)有限公司 | 一种agv激光雷达定位系统及方法 |
CN111142513B (zh) * | 2019-12-02 | 2024-01-26 | 深圳优地科技有限公司 | 初始化坐标的获取方法、调度方法、电子设备及存储介质 |
CN113740355B (zh) * | 2020-05-29 | 2023-06-20 | 清华大学 | 一种射线检测机器人的边界防护方法及系统 |
CN112230664B (zh) * | 2020-10-29 | 2023-06-13 | 深圳市普渡科技有限公司 | 自动回充方法及系统 |
CN112363500B (zh) * | 2020-10-29 | 2023-05-16 | 深圳市普渡科技有限公司 | 自动回充移动方法及系统 |
CN112947441B (zh) * | 2021-02-06 | 2023-10-31 | 湖南克拉宇宙数字科技有限公司 | 一种机器人和充电座自动对接充电的控制方法 |
CN115191884A (zh) * | 2021-04-09 | 2022-10-18 | 美智纵横科技有限责任公司 | 移动控制方法、装置、清洁机器人及存储介质 |
CN113281775A (zh) * | 2021-05-26 | 2021-08-20 | 珠海市一微半导体有限公司 | 一种基于激光扫描信息的充电座定位方法、芯片及机器人 |
CN113485357A (zh) * | 2021-07-29 | 2021-10-08 | 山东新一代信息产业技术研究院有限公司 | 一种室内机器人自动回桩充电系统及方法 |
CN113547502A (zh) * | 2021-08-02 | 2021-10-26 | 苏州触达信息技术有限公司 | 一种智能巡检机器人 |
CN117234196A (zh) * | 2022-06-07 | 2023-12-15 | 速感科技(北京)有限公司 | 自主移动设备、自主移动设备运行方法、系统和存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107539160A (zh) * | 2017-09-29 | 2018-01-05 | 深圳悉罗机器人有限公司 | 充电桩及其识别方法、智能移动机器人 |
CN107894770A (zh) * | 2017-11-24 | 2018-04-10 | 北京奇虎科技有限公司 | 机器人充电座、机器人的充电方法及装置 |
CN108173308A (zh) * | 2018-01-15 | 2018-06-15 | 潍坊歌尔电子有限公司 | 一种机器人充电方法及其装置 |
CN208375332U (zh) * | 2018-05-08 | 2019-01-15 | 深圳市欢创科技有限公司 | 充电座以及移动机器人自动回充系统 |
CN208808368U (zh) * | 2017-08-09 | 2019-05-03 | 深圳市杉川机器人有限公司 | 一种充电座以及扫地机器人 |
CN109870705A (zh) * | 2017-12-01 | 2019-06-11 | 武汉万集信息技术有限公司 | 基于激光雷达的边界目标标识方法及装置 |
CN209842414U (zh) * | 2019-07-16 | 2019-12-24 | 昆山市工研院智能制造技术有限公司 | 机器人充电座 |
-
2019
- 2019-07-16 CN CN201910639957.3A patent/CN110221617B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN208808368U (zh) * | 2017-08-09 | 2019-05-03 | 深圳市杉川机器人有限公司 | 一种充电座以及扫地机器人 |
CN107539160A (zh) * | 2017-09-29 | 2018-01-05 | 深圳悉罗机器人有限公司 | 充电桩及其识别方法、智能移动机器人 |
CN107894770A (zh) * | 2017-11-24 | 2018-04-10 | 北京奇虎科技有限公司 | 机器人充电座、机器人的充电方法及装置 |
CN109870705A (zh) * | 2017-12-01 | 2019-06-11 | 武汉万集信息技术有限公司 | 基于激光雷达的边界目标标识方法及装置 |
CN108173308A (zh) * | 2018-01-15 | 2018-06-15 | 潍坊歌尔电子有限公司 | 一种机器人充电方法及其装置 |
CN208375332U (zh) * | 2018-05-08 | 2019-01-15 | 深圳市欢创科技有限公司 | 充电座以及移动机器人自动回充系统 |
CN209842414U (zh) * | 2019-07-16 | 2019-12-24 | 昆山市工研院智能制造技术有限公司 | 机器人充电座 |
Also Published As
Publication number | Publication date |
---|---|
CN110221617A (zh) | 2019-09-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110221617B (zh) | 机器人充电座、机器人自动回充系统及自动回充方法 | |
US11052944B2 (en) | Auto docking method for application in heavy trucks | |
US11698454B2 (en) | Radar based three dimensional point cloud for autonomous vehicles | |
US9932019B2 (en) | Robot assisted modular battery interchanging system | |
EP3420374A1 (en) | Radar mounting estimation with unstructured data | |
CN112792820B (zh) | 机器人自动回充方法、装置及机器人系统 | |
KR101684033B1 (ko) | 차량을 무선 충전 조립체와 정렬시키기 위한 방법 및 시스템 | |
CN111366901A (zh) | 标定车载毫米波雷达方位角度安装偏差的方法及装置 | |
CN110928307B (zh) | 基于红外激光的自动回充方法、系统、机器人及充电坞 | |
US20210276441A1 (en) | A computerized system for guiding a mobile robot to a docking station and a method of using same | |
CN105699985A (zh) | 一种单线激光雷达装置 | |
WO2006030832A1 (ja) | 監視装置 | |
US20190001831A1 (en) | Method for implementing power supply procedures from at least one power supply unit to a plurality of transportation vehicles to be supplied with power | |
CN104953709A (zh) | 一种变电站智能巡视机器人 | |
CN113067386B (zh) | 一种防爆型巡检机器人无线充电系统及方法 | |
CN113534184B (zh) | 一种激光感知的农业机器人空间定位方法 | |
KR20170041898A (ko) | 모듈러 평면 멀티-섹터 90도 fov 레이더 안테나 아키텍처 | |
CN112821489A (zh) | 一种机器人自主充电装置及其自主充电的方法 | |
JP2000092615A (ja) | 電気自動車用充電システムにおける充電カプラーの位置検出方法及びその装置 | |
CN209842414U (zh) | 机器人充电座 | |
CN110435452A (zh) | 一种无线充电引导定位系统及方法、地面设备、车载设备 | |
KR101040528B1 (ko) | 지형감지 센서조립체 및 이를 구비하는 자율이동 플랫폼 | |
JP2022172489A (ja) | 車両用充電システム | |
WO2020114638A1 (en) | A system and method for alignment of a terminal truck relative to a crane | |
CN115915925A (zh) | 将室外机器人作业工具引导到室外机器人作业工具交互站 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |