一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

机器人及其自动回充方法、控制装置、存储介质与流程

2023-03-01 11:10:23 来源:中国专利 TAG:


1.本发明涉及机器人技术领域,尤其涉及一种机器人及其自动回充方法、控制装置、存储介质。


背景技术:

2.随着科学技术的发展,机器人越来越广泛地应用于各个领域中,在机器人的移动过程中,需要使用传感器探测障碍物等以进行自动避障,同时,机器人都拥有自动回充(自动回到充电桩所在位置并通过该充电桩完成充电)的需求,也即,需要将充电电极准确贴合对接在充电桩上以完成充电。现有技术中,通常将感应器和充电电极同时设置在机器人的前侧,如此,在机器人完成充电时,机器人需要后退以脱离与充电桩的连接,此时,感应器无法对机器人的后退过程进行探测,极有可能在后退时与障碍物或人员发生撞击,甚至可能发生安全事故。现有技术中也存在通过在机器人的后侧再加装传感器,例如激光雷达,以探测后退过程的方案,但该方案将会增加机器人成本,且增加机器人体积,并使得机器人结构更为复杂。


技术实现要素:

3.本发明实施例提供一种机器人及其自动回充方法、控制装置、存储介质,以解决机器人后退时无法通过仅在前侧安装的感应器对机器人的后退过程进行探测的问题。
4.一种机器人,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机可读指令,所述机器人还包括均与所述处理器通信连接的感应传感器和充电电极;所述感应传感器设置在机器人的第一侧,所述充电电极设置在所述机器人的第二侧,所述第一侧与所述第二侧相对设置;所述处理器执行所述计算机可读指令时实现如下步骤:
5.接收充电指令,控制机器人行驶至预设锚点位置;所述预设锚点位置位于充电桩的前方预设距离处;
6.控制所述机器人以预设旋转方向旋转,以将所述机器人旋转到第二侧与所述充电桩对齐;
7.在通过所述感应传感器检测到所述机器人旋转到第二侧与所述充电桩对齐时,控制所述机器人停止旋转并向后直行;
8.在检测到所述充电电极与所述充电桩匹配接触之后,控制所述机器人停止运动并执行充电操作。
9.一种机器人自动回充方法,包括:
10.接收充电指令,控制机器人行驶至预设锚点位置;所述预设锚点位置位于充电桩的前方预设距离处;
11.控制所述机器人以预设旋转方向旋转,以将所述机器人旋转到第二侧与所述充电桩对齐;所述机器人包括设置在机器人的第一侧的感应传感器和设置在所述机器人的第二
侧的充电电极;所述第一侧与所述第二侧相对设置;
12.在通过所述感应传感器检测到所述机器人旋转到第二侧与所述充电桩对齐时,控制所述机器人停止旋转并向后直行;
13.在检测到所述充电电极与所述充电桩匹配接触之后,控制所述机器人停止运动并执行充电操作。
14.一种控制装置,包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机可读指令;所述计算机可读指令被所述处理器执行时实现上述机器人自动回充方法。一种计算机可读存储介质,所述计算机可读存储介质存储有计算机可读指令,所述计算机可读指令被处理器执行时实现上述机器人自动回充方法。
15.上述机器人及其自动回充方法、控制装置、存储介质,所述方法包括:接收充电指令,控制机器人行驶至预设锚点位置;所述预设锚点位置位于充电桩的前方预设距离处;控制所述机器人以预设旋转方向旋转,以将所述机器人旋转到第二侧与所述充电桩对齐;所述机器人包括设置在机器人的第一侧的感应传感器和设置在所述机器人的第二侧的充电电极;所述第一侧与所述第二侧相对设置;在通过所述感应传感器检测到所述机器人旋转到第二侧与所述充电桩对齐时,控制所述机器人停止旋转并向后直行;在检测到所述充电电极与所述充电桩匹配接触之后,控制所述机器人停止运动并执行充电操作。
16.本发明实施例中,无需额外在机器人上加装其他感应传感器,仅需要通过分别设置在机器人上相对的第一侧和第二侧的充电电极和感应传感器,即可实现机器人的自动回充,同时还可以在机器人通过充电电极完成充电之后,使得机器人朝向第一侧直接前进以脱离与充电桩的接触,从而避免与障碍物发生碰撞的有益效果,其结构简单,节省了成本;并且,本发明实施例还解决了将感应传感器和充电电极设置在同一侧时所带来的安装空间拥挤的问题,且充电电极和感应器之间不会发生相互干涉,提升了检测精度。
附图说明
17.为了更清楚地说明本发明实施例的技术方案,下面将对本发明实施例的描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
18.图1是本发明一实施例中机器人的示意图;
19.图2是本发明一实施例中机器人自动回充方法的流程图。
20.图3是本发明一实施例中机器人自动回充方法的步骤s10的流程图。
21.图4是本发明一实施例中机器人自动回充方法的步骤s20的流程图。
22.图5是本发明一实施例中机器人自动回充方法的步骤s30的流程图。
23.图6是本发明一实施例提供的机器人的结构示意图。
24.图7是本发明一实施例提供的机器人的第一侧和第二侧的示意图。
25.图8是本发明另一实施例提供的机器人的第一侧和第二侧的示意图。
26.图9是本发明一实施例中机器人第一侧与充电桩对齐时的示意图。
27.图10是本发明一实施例中机器人处于里程起始位姿时的示意图。
28.说明书中的附图标记如下:
29.1、充电电极;2、感应传感器;21、激光雷达;3、第一侧;4、第二侧;5、底盘;6、机器人本体;100、机器人;200、充电桩;300、探测范围;f、充电桩的前方。
具体实施方式
30.下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
31.在一个实施例中,提供了一种机器人,该机器人的结构图可以如图1和图6所示。该机器人包括通过系统总线连接的处理器、存储器、网络接口和数据库。其中,该机器人的处理器用于提供计算和控制能力。该机器人的存储器包括可读存储介质、内存储器。该可读存储介质存储有操作系统、计算机可读指令和数据库。该内存储器为可读存储介质中的操作系统和计算机可读指令的运行提供环境。该机器人的数据库用于存储与其对应的机器人自动回充方法所使用到的数据。该机器人的网络接口用于与外部的终端通过网络连接通信。该计算机可读指令被处理器执行时以实现一种机器人自动回充方法。本实施例所提供的可读存储介质包括非易失性可读存储介质和易失性可读存储介质。在一可选实施例中,机器人还可以包括输入装置以及显示屏,该输入装置用于接收其它设备发送的信号、文本等;该显示屏可以用于显示机器人100的运动信息等。
32.在一实施例中,如图1所示,提供一种机器人,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机可读指令,如图6所示,所述机器人还包括均与所述处理器通信连接的感应传感器2和充电电极1;所述感应传感器2设置在机器人100的第一侧3,所述充电电极1设置在所述机器人100的第二侧4,所述第一侧3与所述第二侧4相对设置;其中,所述感应传感器2设置在机器人100底盘5上的第一侧3(进一步地,所述第一侧3为所述机器人100的前侧,所述第二侧4为机器人100的后侧),可以用于检测位于机器人100第一侧3的障碍物,为三维避障功能服务,进而有效保护机器人100,以避免与障碍物发生碰撞。在一实施例中,所述感应传感器2包括激光雷达,通过激光雷达可以探测得到障碍物等的位姿数据等,进而可以根据探测到的数据进行定位或指导机器人100避开障碍物。在其他实施例中,感应传感器2还可以包括其他例如rgbd摄像头(深度图像摄像头)、里程计、单目相机、双目相机或者多目相机等,即感应传感器2可以根据实际需求至少包括上述列出的至少一种,进而使得机器人100可以根据感应传感器2采集到的信息进行定位或确定并避开障碍物等。
33.在可选实施例中,充电电极1包括两条间隔设置在机器人100底盘5上的子电极,子电极沿机器人100的底盘5的外侧表面设置。充电电极1的设置形式亦可以根据需求设定为其他形式,只要可以实现与充电桩200匹配接触之后实现对机器人100充电即可。可理解地,第一侧3和第二侧4是设置在同一个机器人100的相对的外侧表面上的两个可以分别用于设置感应传感器2和安装充电电极1的两个结构位置范围。在一具体的实施例中,所述机器人100还包括底盘5以及设置在所述底盘5上的机器人本体6,所述感应传感器2和所述充电电极1均安装在所述底盘5上。其中,机器人本体6和底盘5的连接方式可以根据需求设定,比如卡接、螺钉连接或焊接等均可,只要能实现两者的稳定连接即可。具体地,由于感应传感器2
和所述充电电极1均安装在所述底盘5上,且底盘5的形状可以根据需求设定,比如,底盘5可以为四棱柱,此时,第一侧3和第二侧4可以是指四棱柱底盘5上的两个相对的侧面;而在底盘5为圆柱体或者椭圆柱体时,第一侧3和第二侧4应当为底盘5的外侧表面上的两个相对设置的一定面积的曲面(其中,曲面的面积可以根据需求设定,且两个相对的曲面的面积可以相同或者不相同,但是曲面中可以安装下感应传感器2或充电电极1),进一步地,两个曲面的几何中线点可以以底盘5的中心线为对称轴对称设置。
34.在可选实施例中,底盘5或机器人100为类圆形柱体时(即横截面由不定数量的弧线组成或由不定数量的弧线和不定数量的直线组成的图形),第一侧33和第二侧4相对设置可以是指第一侧3和第二侧4分别存在一条线以底盘5中与高度平行的中心线对称设置,且第一侧3和第二侧4不相连。如图7中所示,底盘5为椭圆柱体,此时,第一侧3包括图7中所示的弧形线段,第二侧4包括图7中所示的弧形线段,且充电电极1安装在第二侧4上,感应传感器2设置在第一侧3上。如图8中所示,底盘5为圆柱体,此时,第一侧3包括图8中所示的圆弧线段,第二侧4包括图8中所示的圆弧线段,且充电电极1安装在第二侧4上,感应传感器2设置在第一侧3上。
35.如图2所示,所述机器人的处理器执行所述计算机可读指令时实现如下步骤:
36.s10,接收充电指令,控制机器人100行驶至预设锚点位置;所述预设锚点位置位于充电桩的前方f预设距离(其中,预设距离可以根据需求设定,感应传感器2的探测范围300应大于该预设距离)处;在本发明的实施例中,机器人100移动至充电电极1与充电桩200匹配接触时,可以实现对机器人100进行充电操作,而在充电结束之后,机器人100需要后退以使得充电电极1与充电桩200脱离。可理解地,充电桩200可以设置在一个固定的安装位置,预设锚点位置可以是指设置在与该安装位置之间相隔预设距离且位于充电桩200的正前方的位置点,但由于充电电极1的子电极呈长条状且沿机器人100的底盘5的外侧表面延伸,因此,预设锚点位置亦可以并不位于充电桩200的正前方,其与正前方的位置点存在一定偏移角度(但是还是需要保证预设锚点位置与该安装位置之间相隔预设距离),亦可通过本发明中的机器人自动回充方法该使得充电电极1最终与充电桩200的匹配接触,以最终实现充电操作。
37.在一可选实施例中,所述步骤s10中,所述接收充电指令之前,所述处理器执行所述计算机可读指令时还实现如下步骤:
38.实时检测所述机器人100的电池电量;在该实施例中,处理器会实时检测机器人100的电池电量,并将实时测得的电池电量与预设电量阈值进行比对,在电池电量大于或等于预设电量阈值时,说明当前并不存在必要的充电需求,此时将会继续实时检测电池电量。其中,预设电量阈值可以由用户根据需求进行设定,其亦可以为默认值,在电池电量低于该预设电量阈值时代表机器人100当前存在充电需求,此时需要对机器人100的电池进行充电。
39.在所述电池电量低于预设电量阈值时,生成所述充电指令。也即,在机器人100的电池电量低于预设电量阈值时,代表机器人100当前存在充电需求,此时需要对机器人100的电池进行充电,因此,处理器将生成充电指令,进而根据该充电指令进入步骤s10,获取预设锚点位置的位置坐标,并控制机器人100行驶至预设锚点位置。在本实施例中,充电指令根据实时测得的电池电量自动生成,无需人工进行操作,实现了机器人100的自动化和智能
化。
40.在另一可选实施例中,所述步骤s10中,所述接收充电指令,包括:接收与所述处理器通信连接的智能终端发送的充电指令,所述充电指令在所述智能终端上的预设充电按键被触发时生成。其中,智能终端可以为智能手机、pad、可穿戴设备等可以移动终端,亦可以为固定设置的计算机设备等均可。预设充电按键是指智能终端上的实体按键或虚拟按键,其可以通过按压、滑动等方式进行触发。在本实施例中,充电指令可以由用户随时通过在智能终端上触发预设充电按键发出,此时,可以实现随时手动控制机器人100执行自动回充。
41.在一实施例中,如图3所示,所述步骤s10中,在控制机器人100行驶至预设锚点位置之前,所述处理器执行所述计算机可读指令时还实现如下步骤:
42.s101,获取所述充电桩200在所述机器人100所处的世界地图中的位置区域;其中,在所述机器人100所处的世界地图中,可以确定与所述机器人100适配的充电桩200;并且,存储器中存储有与机器人100的可移动环境所对应的世界地图,充电桩200的安装位置在世界地图中将会对应一个充电桩200坐标点,在该步骤中,可以直接从世界地图中确定该充电桩200坐标点。而所述位置区域可以是指在世界地图上以充电桩200的充电桩200坐标点为中心向外辐射的一定区域范围,比如,该位置区域可以是指以充电桩200坐标点为圆心且具有预设半径的圆形区域,亦可以是指以充电桩200坐标点为几何中心的矩形区域或者不规则区域均可。
43.s102,控制所述机器人100行驶至所述位置区域中,通过感应传感器2识别所述充电桩200;也即,在机器人100的移动过程中,机器人100的实时移动坐标也将对应映射至世界地图中,在该实时移动坐标落入上述位置区域的范围内时,此时可以通过上述感应传感器2扫描识别充电桩200。
44.s103,在识别到所述充电桩200时,获取所述充电桩200的位姿信息,并根据所述位姿信息确定预设锚点位置;也即,在感应传感器2识别到充电桩200时,可以通过感应传感器2识别到的充电桩200所对应的感应数据确定充电桩200的位姿信息,进而根据该位姿信息确定预设锚点位置。可理解地,由于充电桩200坐标点已经确定,因此,在确定充电桩200的位姿信息之后,预设锚点位置在世界地图中的锚点坐标点亦可以随之确定,之后,即可控制所述机器人100行驶至所述预设锚点位置。也即,在世界地图中确定锚点坐标点之后,即可以根据机器人100当前位置点以及锚点坐标点,规划机器人100在世界地图中的移动路径,进而控制机器人100沿上述移动路径形式至预设锚点位置。
45.进一步地,所述步骤s102中,所述通过感应传感器2识别所述充电桩200,包括:
46.获取所述充电桩200的预设形态特征;其中,预设形态特征表征了充电桩200的形状、大小等特征,通过预设形态特征可以识别充电桩200。预设形态特征是预先存储在存储器中,可供随时调取。在该实施例中,感应传感器2可以为图6中所示的激光雷达21。
47.控制所述感应传感器2在所述位置区域中进行实时探测,以获取所述感应传感器2的探测范围300内的第一特征数据;其中,第一特征数据是指感应传感器2在其探测范围300内实时探测到的感应数据。在该步骤中,机器人可以在位置区域中持续移动(直至确认识别到所述充电桩200时,可以暂停移动;亦可以在预设时间段内一直并未识别到该充电桩200时,提示识别失败并暂停移动),进而在移动过程中通过感应传感器2实时探测以得到第一特征数据,可理解地,第一特征数据中可能会包含充电桩200的相关特征数据,亦可能并不
包含,因此,需要将探测得到的第一特征数据与所述预设形态特征进行对比匹配,进而根据对比匹配结果确定感应传感器2是否已经识别到充电桩200。
48.可理解地,在一实施例中,在所述第一特征数据与所述预设形态特征之间的匹配度大于或等于第一预设阈值时,确认识别到所述充电桩200;也即,第一预设阈值根据需求设定,比如,可以设定为60%~100%之间的任何数值;可理解地,在第一特征数据与所述预设形态特征之间的匹配度大于或等于第一预设阈值时,说明对比匹配结果是感应传感器2已经探测识别到充电桩200,此时可以进入步骤s103中,进一步获取所述充电桩200的位姿信息,并根据所述位姿信息确定预设锚点位置。
49.在另一实施例中,在所述第一特征数据与所述预设形态特征之间的匹配度小于所述第一预设阈值时,继续控制所述感应传感器2在所述位置区域中进行实时探测,以继续获取所述感应传感器2的探测范围300内的第一特征数据。可理解地,在第一特征数据与所述预设形态特征之间的匹配度小于第一预设阈值时,说明对比匹配结果是感应传感器2并未探测识别到充电桩200,此时将继续控制感应传感器2在所述位置区域中进行实时探测以持续获取不同的第一特征数据,直至识别到充电桩200之后,进入步骤s103中进行下一步操作。
50.s20,控制所述机器人100以预设旋转方向旋转,以将所述机器人100旋转到第二侧4与所述充电桩200对齐;其中,该预设旋转方向可以根据需求设定,预设旋转方向可以是逆时针或者顺时针中的一种。可理解地,在该步骤中,若在机器人100行驶到预设锚点位置时,机器人100第一侧3已经与所述充电桩200对齐,此时即可直接开始控制机器人100以预设旋转方向旋转,以将所述机器人100旋转到第二侧4与所述充电桩200对齐。
51.而在在机器人100行驶到预设锚点位置时,机器人100第一侧3尚未与所述充电桩200对齐,此时,进一步地,所述步骤s20中,在所述控制所述机器人100以预设旋转方向旋转,以将所述机器人100旋转到第二侧4与所述充电桩200对齐之前,所述处理器执行所述计算机可读指令时还实现将机器人100的第一侧3调整至与所述充电桩200对齐;其中,所述将机器人100的第一侧3调整至与所述充电桩200对齐,具体包括:
52.获取机器人100抵达所述预设锚点位置时的第一位姿;在本发明的实施例中,存储器中存储有与机器人100的可移动环境所对应的世界地图,且在机器人100的行走过程中,可以通过机器人100上安装的传感器(可以为上述感应传感器2,亦可以为其他传感器)采集得到的感应数据以及该世界地图,确定机器人100的实时位姿,因此,在机器人100抵达预设锚点位置时,处理器可以直接获取该时刻所对应的机器人100的第一位姿。
53.根据所述第一位姿确定第一调整角度和第二调整角度,所述第一调整角度是指所述机器人100顺时针旋转至第一侧3与所述充电桩200对齐所对应的旋转角度;所述第二调整角度是指所述机器人100逆时针旋转至第一侧3与所述充电桩200对齐所对应的旋转角度;
54.在所述第一调整角度小于或等于所述第二调整角度时,控制所述机器人100以顺时针旋转至第一侧3与所述充电桩200对齐;
55.在所述第一调整角度大于所述第二调整角度时,控制所述机器人100以逆时针旋转至第一侧3与所述充电桩200对齐。
56.在该实施例中,可以根据机器人100抵达所述预设锚点位置时的第一位姿,确定机
器人100分别在顺时针方向和逆时针方向旋转时,将第一侧3旋转至与充电桩200对齐时各自对应的第一调整角度和第二调整角度,进而将第一调整角度和第二调整角度中的较小值对应的旋转方向(顺时针或逆时针)作为机器人100旋转到第二侧4与所述充电桩200对齐时所采用的旋转方向,可理解地,在上述实施例中,在第一调整角度小于或等于所述第二调整角度时,机器人100旋转到第二侧4与所述充电桩200对齐时所采用的旋转方向预设为顺时针,但在本发明的其他实施例中,在第一调整角度小于或等于所述第二调整角度时,机器人100旋转到第二侧4与所述充电桩200对齐时所采用的旋转方向亦可以是逆时针。
57.s30,在通过所述感应传感器2检测到所述机器人100旋转到第二侧4与所述充电桩200对齐时,控制所述机器人100停止旋转并向后直行;也即,感应传感器2检测到所述机器人100旋转到第二侧4与所述充电桩200对齐时,说明机器人100只要向后直行而不发生偏转,即可直接后退至充电电极1与所述充电桩200匹配接触,进而完成充电。
58.s40,在检测到所述充电电极1与所述充电桩200匹配接触之后,控制所述机器人100停止运动并执行充电操作。也即,若机器人100通过处理器检测到充电电极1与所述充电桩200匹配接触,此时机器人100首先需要停止运动,进而生成接触信号之后,根据接触信号完成充电操作,具体地,机器人100可以直接向充电桩200发送充电开启指令,此时充电桩200将与机器人100之间通电并开启充电操作;在另一可选实施例中,亦可以是充电桩200检测到充电电极1与所述充电桩200匹配接触,并向机器人100发送接触信号,机器人100可以根据接收到的接触信号确认充电电极1与所述充电桩200匹配接触进而停止运动,之后向充电桩200发送充电开启指令,此时充电桩200将与机器人100之间通电并开启充电操作。
59.本发明实施例中,无需额外在机器人100上加装其他感应传感器2,仅需要通过分别设置在机器人100上相对的第一侧3和第二侧4的充电电极1和感应传感器2,即可实现机器人100的自动回充,同时还可以在机器人100通过充电电极1完成充电之后,使得机器人100朝向第一侧3直接前进以脱离与充电桩200的接触,从而避免与障碍物发生碰撞的有益效果,其结构简单,节省了成本;并且,本发明实施例还解决了将感应传感器2和充电电极1设置在同一侧时所带来的安装空间拥挤的问题,且充电电极1和感应器之间不会发生相互干涉,提升了检测精度。
60.在一实施例中,如图4所示,所述感应传感器2包括与所述处理器通信连接的激光雷达;所述步骤s20,也即所述控制所述机器人100以预设旋转方向旋转,以将所述机器人100旋转到第二侧4与所述充电桩200对齐,包括:
61.s201,通过所述激光雷达实时探测所述充电桩200并获取感应数据;也即,在该实施例中,感应传感器2包括图6中所示的激光雷达21,在激光雷达21的探测范围300内(也即激光开角范围内,在一可选实施例中,激光开角可以优选为180~230度,进一步地,激光开角为230度),激光雷达21将会持续探测充电桩200的感应数据,此时,由于在开始旋转时,安装在第一侧3的激光雷达21与充电桩200对齐,因此,如图9所示,充电桩200必然处于激光雷达21的激光开角范围(也即探测范围300)内,而随着机器人100的持续旋转,充电桩200在某一时刻将会开始有一部分超出上述激光开角范围,此时,可以根据激光雷达21所实时探测得到的感应数据,确定如图10中所示的将要超出激光雷达21的探测范围300和尚未超出激光雷达21的探测范围300之间所对应的临界时间点,并将该临界时间点确定为检测到所述充电桩200超出所述激光雷达21的探测范围300的时间点。并且,该临界时间点所对应的机
器人100的当前位姿将被记录为里程起始位姿。
62.s202,在检测到所述充电桩200超出所述激光雷达21的探测范围300时,根据所述感应数据确定旋转定位角度,并将机器人100的当前位姿记录为里程起始位姿;所述旋转定位角度是指机器人100从所述里程起始位姿转动到第二侧4对齐所述充电桩200所对应的旋转角度;也即,在检测到所述充电桩200超出所述激光雷达21的探测范围300的临界时间点开始,将根据感应数据进一步确定从该临界时间点继续旋转到第二侧4对齐所述充电桩200时所需要持续旋转的旋转定位角度。
63.s203,实时获取所述机器人100从所述里程起始位姿开始旋转的里程旋转角度,并在所述里程旋转角度达到所述旋转定位角度时,确定所述机器人100已旋转到第二侧4与所述充电桩200对齐。也即,在该步骤中,可以通过里程计记录机器人100从里程起始位置位姿的里程旋转角度,进而根据该里程旋转角度指导机器人100在上述旋转定位角度内旋转,最终实现机器人100旋转到第二侧4与所述充电桩200对齐。
64.可理解地,在上述实施例中,在临界时间点之前,通过激光雷达21探测得到的感应数据指导机器人100的旋转(充电桩200完全处于机器人100的激光雷达21的探测范围300内),而在临界时间点之后(充电桩200至少有一部分不再处于机器人100的激光雷达21的探测范围300内),通过里程计指导机器人100持续旋转到第二侧4与所述充电桩200对齐。在整个旋转过程中,均可以通过激光雷达21或者里程计持续获取充电桩200相对于机器人100的位姿(x,y,theta),并通过下式计算充电桩200与机器人100正前方的夹角:included_angle=atan2(y,x)。当机器人100在旋转的过程中最后一帧检测到充电桩200时(也即在临界时间点),会记录此时充电桩200与机器人100正后方的夹角theta(last),此时,若机器人100的激光雷达21的激光开角为230
°
,且机器人100旋转过程中保证以机器人100的底盘5中心线为旋转轴,可得此时theta(last)为65
°
;可理解地,在机器人100并未以机器人100底盘5中心线为旋转轴(旋转过程中的旋转轴存在一定范围的偏移)时,theta(last)也可以视为为65
°
左右;而若旋转轴的偏移过大时,也将可以根据激光雷达21的激光开角、激光雷达的旋转半径等计算出theta(last),在此不再赘述。
65.可理解地,在该实施例中,感应传感器2(比如激光雷达21)作为机器人100探测障碍物的必要元器件之一,原本就需要持续进行探测工作并探测得到感应数据(以确定障碍物是否存在并进行避障等处理),因此,使用激光雷达21检测临界时间点之前的充电桩200的旋转过程,并通过其探测得到的感应数据再进行旋转定位角度的确定,减少了使用里程计来作为标准进行机器人100旋转的角度指引,可以节约资源,降低成本。
66.进一步地,所述步骤s201,也即所述通过感应传感器2实时探测所述充电桩200并获取感应数据,包括:
67.在所述机器人100以预设旋转方向(可以为逆时针或者顺时针的一种)旋转的过程中,在所述激光雷达21的探测范围300内实时探测第二特征数据;其中,第二特征数据是指激光雷达21在其探测范围300内实时探测到的感应数据。在机器人100开始旋转时,安装在第一侧3的激光雷达21与充电桩200对齐,因此,如图9所示,充电桩200必然处于激光雷达21的探测范围300内,此时,第二特征数据与所述预设形态特征之间的匹配度将会大于或等于第二预设阈值;而随着机器人100的持续旋转,充电桩200在某一时刻将会开始有一部分超出上述探测范围300,此时,第二特征数据与所述预设形态特征之间的匹配度将由大于或等
于第二预设阈值逐渐变为小于第二预设阈值;其中,第二预设阈值可以根据需求设定,可理解地,上文中提及的第一预设阈值是用于识别充电桩200的一个预设数值,而第二预设阈值是用于识别充电桩200是否开始有一部分超出上述探测范围300的识别,因此第二预设阈值必然大于第一预设阈值,进一步地,第二预设阈值可以设定为95%~100%中的其中一个数值。
68.获取所述充电桩的预设形态特征;其中,预设形态特征表征了充电桩200的形状、大小等特征,通过预设形态特征可以识别充电桩200。预设形态特征是预先存储在存储器中,可供随时调取。在该实施例中,感应传感器2可以为图6中所示的激光雷达21。
69.在所述第二特征数据与所述预设形态特征之间的匹配度大于或等于第二预设阈值时,确认所述充电桩200并未超出所述激光雷达21的探测范围300;可理解地,在所述第二特征数据与所述预设形态特征之间的匹配度大于或等于第二预设阈值时,说明所述充电桩200并未开始超出所述激光雷达21的探测范围300,此时,将继续在激光雷达21的探测范围300内实时探测第二特征数据即可,直至所述充电桩200开始超出所述激光雷达21的探测范围300之后,进入步骤s202,根据所述感应数据确定旋转定位角度。
70.在所述第二特征数据与所述预设形态特征之间的匹配度小于所述第二预设阈值时,确认所述充电桩200超出所述激光雷达21的探测范围300。可理解地,在所述第二特征数据与所述预设形态特征之间的匹配度小于第二预设阈值时,说明所述充电桩200开始超出所述激光雷达21的探测范围300,此时,将进入步骤s202,根据所述感应数据确定旋转定位角度。
71.在一可选实施例中,所述步骤s202中,所述根据所述感应数据确定旋转定位角度,包括:
72.根据所述充电桩200的宽度、所述预设距离和所述激光雷达21的水平视角范围确定目标旋转角度;也即,目标旋转角度是指机器人100在理想状态下旋转(旋转过程中保持以机器人100的底盘5中心线为旋转轴),此时,可以根据充电桩200的宽度、所述预设距离和所述激光雷达21的水平视角范围(激光雷达21的水平视角范围即为激光雷达在图9和图10中所示的水平方向上的激光开角)确定目标旋转角度。目标旋转角度是指机器人100在理想状态下旋转到上述临界时间点时所需要转过的角度。
73.自所述感应数据中获取所述机器人100的当前位姿,根据所述当前位姿确定第一预估旋转角度;具体地,根据机器人100的当前位姿以及其在预设锚点位置开始旋转时的起始位姿(机器人100第一侧3与所述充电桩200对齐时对应的位姿),即可以确定机器人100的第一预估旋转角度。
74.在所述第一预估旋转角度与所述目标旋转角度之间的第一偏差角度在预设偏差范围内时,将所述第一预估旋转角度确定为旋转定位角度。也即,第一偏差角度可以是指第一预估旋转角度与所述目标旋转角度之间的差值。在第一预估旋转角度与所述目标旋转角度之间的第一偏差角度在预设偏差范围内(根据需求预先设定)时,说明机器人100在理想状态下旋转或者可以视为在理想状态下旋转,此时,可以将所述第一预估旋转角度确定为旋转定位角度,进而根据该旋转定位角度进行下一步由里程计指引的旋转过程。在该实施例中,确定目标旋转角度以及第一预估旋转角度的顺序并不做限定,也即,先确定目标旋转角度或第一预估旋转角度均可,甚至同时获取两者亦可。
75.进一步地,在上述实施例中,确定目标旋转角度以及第一预估旋转角度之后,所述处理器执行所述计算机可读指令时还实现如下步骤:
76.在所述第一预估旋转角度与所述目标旋转角度之间的第一偏差角度超出预设偏差范围时,根据所述第一偏差角度将所述机器人100的当前位姿调整至目标位姿;
77.在与所述目标位姿对应的第二预估旋转角度与所述目标旋转角度之间的第二偏差角度在预设偏差范围内时,将所述第二预估旋转角度确定为旋转定位角度。
78.在该实施例中,在第一预估旋转角度与所述目标旋转角度之间的第一偏差角度超出预设偏差范围时,说明机器人100不能视为在理想状态下旋转,此时,旋转轴偏移过大,可以首先根据上述第一偏差角度调整机器人100的当前位姿至目标位姿,在本实施例中,所需要调整的机器人100的目标位姿包含以下特征:机器人100在目标位姿上时的底盘5中心线位于充电桩200的正前方所指向的方向上(或者与该方向之间的偏移在预设轴偏移范围内),且机器人100从起始位姿(机器人100第一侧3与所述充电桩200对齐时对应的位姿)开始旋转到目标位置时的旋转角度(也即将被确定为旋转定位角度的第二预估旋转角度)与第一预估旋转角度之间的偏差值在预设偏差范围内。上述调整过程可以参照上述步骤s20及其相关过程,在此不再赘述。
79.在一可选实施例中,所述感应传感器2还包括与所述处理器通信连接的里程计;所述步骤s203中,所述实时获取所述机器人100从所述里程起始位姿开始旋转的里程旋转角度,包括:
80.通过所述里程计实时获取所述机器人100从所述里程起始位姿开始旋转的第一里程数据,并根据所述第一里程数据确定所述机器人100的里程旋转角度。也即,在该实施例中,第一里程数据包括里程计检测到的其旋转过程中的运动里程轨迹等,比如,速度、加速度和位移等;进而,根据上述第一里程数据即可确定机器人100的里程旋转角度。
81.在一实施例中,所述感应传感器2包括与所述处理器通信连接的里程计;所述步骤s20中,所述控制所述机器人100以预设旋转方向旋转,以将所述机器人100旋转到第二侧4与所述充电桩200对齐,包括:
82.通过所述里程计实时获取所述机器人100旋转过程中的第二里程数据,并根据所述第二里程数据确定所述机器人100的实时旋转角度;也即,在该实施例中,第二里程数据包括里程计检测到的其旋转过程中的运动里程轨迹等,比如,速度、加速度和位移等;进而,根据上述第二里程数据即可确定机器人100的实时旋转角度。
83.在所述实时旋转角度等于预设角度阈值时,确定所述机器人100已旋转到第二侧4与所述充电桩200对齐。预设角度阈值可以根据需求设定,可以是指机器人100在理想状态下从第一侧3与充电桩200对其旋转至第二侧4与充电桩200对其所对应的旋转角度,比如180度。可理解地,在所述实时旋转角度小于预设角度阈值时,说明所述机器人100并未旋转到第二侧4与所述充电桩200对齐,此时机器人100将继续旋转。在上述实施例中,在机器人100的整个旋转过程中,均仅通过里程计指导机器人100的持续旋转,直至确认机器人100第二侧4与所述充电桩200对齐。
84.在一实施例中,如图5所示,所述步骤s30中,所述控制所述机器人100停止旋转并向后直行之后,所述处理器执行所述计算机可读指令时还实现如下步骤:
85.s301,实时获取所述机器人100向后直行的后行距离;也即,机器人100向后直行的
后行距离可以通过里程计实时获取。
86.s302,在所述后行距离小于或等于后退距离阈值时,若检测到所述充电电极1与所述充电桩200的接触信号,则确认所述充电电极1与所述充电桩200匹配接触;所述后退距离阈值大于或等于所述预设距离;其中,后退距离阈值可以根据需求设定为大于预设距离(预设锚点位置与充电桩200之间的距离)且与预设距离的差值在一定范围内的一个距离值,以避免旋转或者向后直行过程中出现可控范围内的移动偏差时,机器人100还可以正常向后直行最终实现充电电极1与所述充电桩200匹配接触。接触信号将在充电电极1与所述充电桩200匹配接触时生成,也即,若机器人100通过处理器检测到充电电极1与所述充电桩200匹配接触则生成接触信号;在另一可选实施例中,亦可以是充电桩200检测到充电电极1与所述充电桩200匹配接触,并向机器人100发送接触信号,机器人100可以根据接收到的接触信号确认充电电极1与所述充电桩200匹配接触。
87.s303,在所述后行距离小于或等于所述后退距离阈值时,若并未检测到所述充电电极1与所述充电桩200的接触信号,则继续控制所述机器人100向后直行。也即,在该实施例中,当后行距离小于或等于后退距离阈值,且检测到接触信号时,说明充电电极1与所述充电桩200匹配接触,此时可以直接对该机器人100进行充电操作之后,提示充电成功。而在当后行距离小于或等于后退距离阈值,且并未检测到接触信号时,说明机器人100的充电电极1并未与充电桩200匹配接触,此时由于后行距离并未大于后退距离阈值,说明机器人100尚未运动到充电桩200所在位置,因此将继续控制所述机器人100向后直行,此时也可以提示尚未开始充电。
88.进一步地,所述步骤s301之后,也即所述实时获取所述机器人100向后直行的后行距离之后,所述处理器执行所述计算机可读指令时还实现如下步骤:
89.在所述后行距离大于后退距离阈值时,若尚未检测到所述充电电极1与所述充电桩200的接触信号,则控制所述机器人100停止运动并提示充电失败。也即,在当后行距离大于后退距离阈值时,说明机器人100在理想状态下(机器人100旋转之后,第二侧4与充电桩200正前方对齐)已经向后直行了足够抵达充电桩200的距离,因此,此时还尚未检测到所述充电电极1与所述充电桩200的接触信号,说明机器人100在旋转过程中或者向后直行过程中发生了非正常偏移,因此,此时需要控制所述机器人100停止运动并提示充电失败。在一可选实施例中,机器人100可以重新自动生成新的充电指令(或用户接收到充电失败的提示之后,通过智能终端重新发送充电指令)之后,再次进入步骤s10中进行再一次自动回充。
90.在一实施例中,提供一种机器人自动回充方法,所述机器人自动回充方法应用于上述机器人的处理器,如图2所示,所述机器人自动回充方法包括如下步骤:
91.s10,接收充电指令,控制机器人100行驶至预设锚点位置;所述预设锚点位置位于充电桩的前方f预设距离处;
92.s20,控制所述机器人100以预设旋转方向旋转,以将所述机器人100旋转到第二侧4与所述充电桩200对齐;所述机器人100包括设置在机器人100的第一侧3的感应传感器2和设置在所述机器人100的第二侧4的充电电极1;所述第一侧3与所述第二侧4相对设置;
93.s30,在通过所述感应传感器2检测到所述机器人100旋转到第二侧4与所述充电桩200对齐时,控制所述机器人100停止旋转并向后直行;
94.s40,在检测到所述充电电极1与所述充电桩200匹配接触之后,控制所述机器人
100停止运动并执行充电操作。
95.本发明实施例中,无需额外在机器人100上加装其他感应传感器2,仅需要通过分别设置在机器人100上相对的第一侧3和第二侧4的充电电极1和感应传感器2,即可实现机器人100的自动回充,同时还可以在机器人100通过充电电极1完成充电之后,使得机器人100朝向第一侧3直接前进以脱离与充电桩200的接触,从而避免与障碍物发生碰撞的有益效果,其结构简单,节省了成本;并且,本发明实施例还解决了将感应传感器2和充电电极1设置在同一侧时所带来的安装空间拥挤的问题,且充电电极1和感应器之间不会发生相互干涉,提升了检测精度。
96.进一步地,所述接收充电指令之前,包括:
97.实时检测所述机器人100的电池电量;
98.在所述电池电量低于预设电量阈值时,生成所述充电指令。
99.进一步地,所述接收充电指令,包括:
100.接收与所述处理器通信连接的智能终端发送的充电指令,所述充电指令在所述智能终端上的预设充电按键被触发时生成。
101.在一实施例中,如图3所示,在控制机器人100行驶至预设锚点位置之前,包括:
102.s101,获取所述充电桩200在所述机器人100所处的世界地图中的位置区域;
103.s102,控制所述机器人100行驶至所述位置区域中,通过感应传感器2识别所述充电桩200;
104.s103,在识别到所述充电桩200时,获取所述充电桩200的位姿信息,并根据所述位姿信息确定预设锚点位置。
105.进一步地,所述通过感应传感器2识别所述充电桩200,包括:
106.获取所述充电桩200的预设形态特征;
107.控制所述感应传感器2在所述位置区域中进行实时探测,以获取所述感应传感器2的探测范围300内的第一特征数据;
108.在所述第一特征数据与所述预设形态特征之间的匹配度大于或等于第一预设阈值时,确认识别到所述充电桩200;和/或
109.在所述第一特征数据与所述预设形态特征之间的匹配度小于所述第一预设阈值时,继续控制所述感应传感器2在所述位置区域中进行实时探测。
110.在一实施例中,所述控制所述机器人以预设旋转方向旋转,以将所述机器人旋转到第二侧与所述充电桩对齐之前,所述机器人自动回充方法还包括将机器人的第一侧调整至与所述充电桩对齐;其中,所述将机器人的第一侧调整至与所述充电桩对齐具体包括:
111.获取机器人100抵达所述预设锚点位置时的第一位姿;
112.根据所述第一位姿确定第一调整角度和第二调整角度,所述第一调整角度是指所述机器人100的第一侧3顺时针旋转至与所述充电桩200对齐所对应的旋转角度;所述第二调整角度是指所述机器人100的第一侧3逆时针旋转至与所述充电桩200对齐所对应的旋转角度;
113.在所述第一调整角度小于或等于所述第二调整角度时,控制所述机器人100以顺时针旋转至第一侧3与所述充电桩200对齐;
114.在所述第一调整角度大于所述第二调整角度时,控制所述机器人100以逆时针旋
转至第一侧3与所述充电桩200对齐。
115.在一实施例中,如图4所示,所述感应传感器2包括激光雷达21;
116.所述控制所述机器人100以预设旋转方向旋转,以将所述机器人100旋转到第二侧4与所述充电桩200对齐,包括:
117.s201,通过所述激光雷达21实时探测所述充电桩200并获取感应数据;
118.s202,在检测到所述充电桩200超出所述激光雷达21的探测范围300时,根据所述感应数据确定旋转定位角度,并将机器人100的当前位姿记录为里程起始位姿;所述旋转定位角度是指机器人100从所述里程起始位姿转动到第二侧4对齐所述充电桩200所对应的旋转角度;
119.s203,实时获取所述机器人100从所述里程起始位姿开始旋转的里程旋转角度,并在所述里程旋转角度达到所述旋转定位角度时,确定所述机器人100已旋转到第二侧4与所述充电桩200对齐。
120.进一步地,所述通过激光雷达21实时探测所述充电桩200并获取感应数据,包括:
121.在所述机器人100以预设旋转方向旋转的过程中,在所述激光雷达21的探测范围300内实时探测第二特征数据;
122.获取所述充电桩的预设形态特征;
123.在所述第二特征数据与所述预设形态特征之间的匹配度大于或等于第二预设阈值时,确认所述充电桩200并未超出所述激光雷达21的探测范围300;
124.在所述第二特征数据与所述预设形态特征之间的匹配度小于所述第二预设阈值时,确认所述充电桩200超出所述激光雷达21的探测范围300。
125.在一实施例中,所述根据所述感应数据确定旋转定位角度,包括:
126.根据所述充电桩200的宽度、所述预设距离和所述激光雷达21的水平视角范围确定目标旋转角度;
127.自所述感应数据中获取所述机器人100的当前位姿,根据所述当前位姿确定第一预估旋转角度;
128.在所述第一预估旋转角度与所述目标旋转角度之间的第一偏差角度在预设偏差范围内时,将所述第一预估旋转角度确定为旋转定位角度。
129.进一步地,所述机器人自动回充方法还包括:
130.在所述第一预估旋转角度与所述目标旋转角度之间的第一偏差角度超出预设偏差范围时,根据所述第一偏差角度将所述机器人100的当前位姿调整至目标位姿;
131.在与所述目标位姿对应的第二预估旋转角度与所述目标旋转角度之间的第二偏差角度在预设偏差范围内时,将所述第二预估旋转角度确定为旋转定位角度。
132.在一实施例中,所述感应传感器2还包括里程计;所述实时获取所述机器人100从所述里程起始位姿开始旋转的里程旋转角度,包括:
133.通过里程计实时获取所述机器人100从所述里程起始位姿开始旋转的第一里程数据,并根据所述第一里程数据确定所述机器人100的里程旋转角度。
134.在一实施例中,所述感应传感器2包括里程计;所述控制所述机器人100以预设旋转方向旋转,以将所述机器人100旋转到第二侧4与所述充电桩200对齐,包括:
135.通过里程计实时获取所述机器人100旋转过程中的第二里程数据,并根据所述第
二里程数据确定所述机器人100的实时旋转角度;
136.在所述实时旋转角度等于预设角度阈值时,确定所述机器人100已旋转到第二侧4与所述充电桩200对齐。
137.在一实施例中,如图5所示,所述控制所述机器人100停止旋转并向后直行之后,还包括:
138.s301,实时获取所述机器人100向后直行的后行距离;
139.s302,在所述后行距离小于或等于后退距离阈值时,若检测到所述充电电极1与所述充电桩200的接触信号,则确认所述充电电极1与所述充电桩200匹配接触;所述后退距离阈值大于或等于所述预设距离;
140.s303,在所述后行距离小于或等于所述后退距离阈值时,若并未检测到所述充电电极1与所述充电桩200的接触信号,则继续控制所述机器人100向后直行。
141.进一步地,所述实时获取所述机器人100向后直行的后行距离之后,还包括:
142.在所述后行距离大于后退距离阈值时,若尚未检测到所述充电电极1与所述充电桩200的接触信号,则控制所述机器人100停止运动并提示充电失败。
143.应理解,上述实施例中各步骤的序号的大小并不意味着执行顺序的先后,各过程的执行顺序应以其功能和内在逻辑确定,而不应对本发明实施例的实施过程构成任何限定。
144.可理解地,上述机器人100还包括壳体。该机器人中的元器件,比如处理器、存储器、里程计等设置于机器人100壳体内部,以达到对其进行保护的目的。而感应传感器2可以设置在壳体上,以便于对障碍物以及充电桩200等信息进行及时探测。
145.在一实施例中,提供一种控制装置,包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机可读指令;所述计算机可读指令被所述处理器执行时实现上述机器人自动回充方法。其中,该控制装置可以是服务器。该控制装置可以包括通过系统总线连接的处理器、存储器、网络接口和数据库。该控制装置的处理器用于提供计算和控制能力。该控制装置的存储器包括可读存储介质、内存储器。该可读存储介质存储有操作系统、计算机可读指令和数据库,该可读存储介质包括易失性存储介质和非易失性存储介质。该内存储器为可读存储介质中的操作系统和计算机可读指令的运行提供环境。该控制装置的网络接口用于与外部的终端通过网络连接通信。该计算机可读指令被处理器执行时以实现上述机器人自动回充方法。
146.在一个实施例中,提供了一种计算机可读存储介质,其上存储有计算机可读指令,计算机可读指令被处理器执行时实现上述实施例中的机器人自动回充方法。
147.本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机可读指令来指令相关的硬件来完成,所述的计算机可读指令可存储于一计算机可读取存储介质中,该计算机可读指令在执行时,可包括如上述各方法的实施例的流程。其中,本技术所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用,均可包括非易失性和/或易失性存储器。非易失性存储器可包括只读存储器(rom)、可编程rom(prom)、电可编程rom(eprom)、电可擦除可编程rom(eeprom)或闪存。易失性存储器可包括随机存取存储器(ram)或者外部高速缓冲存储器。作为说明而非局限,ram以多种形式可得,诸如静态ram(sram)、动态ram(dram)、同步dram(sdram)、双数据率sdram(ddrsdram)、增
强型sdram(esdram)、同步链路(synchlink)dram(sldram)、存储器总线(rambus)直接ram(rdram)、直接存储器总线动态ram(drdram)、以及存储器总线动态ram(rdram)等。
148.所属领域的技术人员可以清楚地了解到,为了描述的方便和简洁,仅以上述各功能单元、模块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同的功能单元、模块完成,即将所述装置的内部结构划分成不同的功能单元或模块,以完成以上描述的全部或者部分功能。
149.以上所述实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围,均应包含在本发明的保护范围之内。
再多了解一些

本文用于创业者技术爱好者查询,仅供学习研究,如用于商业用途,请联系技术所有人。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献