CN110162063A - 一种用于机器人自动充电的路径规划方法和装置 - Google Patents
一种用于机器人自动充电的路径规划方法和装置 Download PDFInfo
- Publication number
- CN110162063A CN110162063A CN201910508730.5A CN201910508730A CN110162063A CN 110162063 A CN110162063 A CN 110162063A CN 201910508730 A CN201910508730 A CN 201910508730A CN 110162063 A CN110162063 A CN 110162063A
- Authority
- CN
- China
- Prior art keywords
- robot
- alternate trajectory
- alternate
- sample
- evaluation
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 54
- 238000011156 evaluation Methods 0.000 claims abstract description 45
- 238000012545 processing Methods 0.000 claims description 11
- 230000004888 barrier function Effects 0.000 claims description 9
- 238000001514 detection method Methods 0.000 claims description 9
- 230000004927 fusion Effects 0.000 claims description 4
- 238000009499 grossing Methods 0.000 claims description 4
- 238000013481 data capture Methods 0.000 claims description 3
- 238000002844 melting Methods 0.000 claims 1
- 230000008018 melting Effects 0.000 claims 1
- 238000003032 molecular docking Methods 0.000 claims 1
- 230000007812 deficiency Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 10
- 230000006870 function Effects 0.000 description 7
- 230000008901 benefit Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 241000208340 Araliaceae Species 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 230000008447 perception 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/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- 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/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- 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
- G05D1/0242—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
-
- 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/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Acoustics & Sound (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种用于机器人自动充电的路径规划方法和装置。方法包括:在机器人电量不足时,对机器人的位置进行定位;运用改进型动态窗口法构建一组机器人的备选轨迹空间;以机器人的位置到外部充电器的距离和位姿夹角为目标,对备选轨迹空间内每一条备选轨迹进行评价,生成每一条备选轨迹的评价值;基于生成的每一条备选轨迹的评价值,选择最优的备选轨迹作为机器人的移动轨迹,控制机器人进行移动;判断机器人的位置是否为机器人要到达的外部充电器位置,若为是,则将机器人的充电接口与外部充电器对接,若为否,则继续运用改进型动态窗口法构建机器人的备选轨迹空间,直至到达充电器位置。该方案可驱动机器人有效避开障碍物,实现快速自动充电。
Description
技术领域
本发明涉及机器人路径规划技术领域,特别涉及一种用于机器人自动充电的路径规划方法和装置。
背景技术
随着社会经济的发展和科学技术的进步,移动机器人需要智能感应自身电量信息,实现自动充电功能。
机器人携带红外传感器、超声波传感器模块等多种传感检测设备,通过感知的环境信息,利用动态窗口算法规划一条优化路径,实现自动充电。但是,现有技术中,由于规划的机器人进行自动的路径不合理,存在效率不高的问题。
发明内容
本发明的实施例提供一种用于机器人自动充电的路径规划方法和装置,用以驱动机器人有效避开障碍物位置,且快速到达外部充电器位置。
为达到上述目的,本发明的实施例采用如下技术方案:
第一方面,本发明实施例提供一种用于机器人自动充电的路径规划方法,包括:
S1、接收机器人电量不足的提示信息;
S2、对机器人的位置进行定位;
S3、运用改进型动态窗口法构建一组机器人的备选轨迹空间;
S4、以机器人的位置到外部充电器的距离和位姿夹角为目标,对备选轨迹空间内每一条备选轨迹进行评价,生成每一条备选轨迹的评价值;
S5、基于生成的每一条备选轨迹的评价值,选择最优的备选轨迹作为机器人的移动轨迹,控制机器人进行移动;
S6、判断机器人的位置是否为机器人要到达的外部充电器位置,若为是,则执行S7,若为否,则执行S3;
S7、将机器人的充电接口与外部充电器对接,实现自动充电。
如上所述的方法中,在S3中所述运用改进型动态窗口法构建一组机器人的备选轨迹空间,包括:
确定机器人的最大速度、动态规划的速度间隔和角速度间隔;
利用机器人的最大速度、动态规划的速度间隔和角速度间隔确定机器人的速度样本;所述速度样本包括:横向速度样本、纵向速度样本和角速度样本;
基于速度样本推算机器人下一时刻的备选位置,得到当前位置到备选位置的备选轨迹,所有速度样本的组合推算出一组机器人的备选轨迹空间。
如上所述的方法中,所述基于速度样本推算机器人下一时刻的备选位置,具体为:利用以下公式和机器人当前t时刻的位置推算下一时刻t+1的备选位置;
θt+1=θt+vθ;
xt+1=xt+vx×cos(θt+1)-vy×sin(θt+1);
yt+1=yt+vx×sin(θt+1)+vy×cos(θt+1);
式中,vx为横向速度样本,vy为纵向速度样本,vθ为角速度样本;xt、yt、θt分别为机器人当前时刻t的横向坐标、纵向坐标和方向角;xt+1、yt+1、θt+1分别为机器人下一时刻t+1的横向坐标、纵向坐标和方向角。
如上所述的方法中,对备选轨迹空间中的每一条轨迹进行评价,利用以下评价函数生成每一条轨迹的评价值;
F(vx,vy,vθ)=α1×s(bt+1,B)+α2×γ(ω1-ω2)+α3×μ(vx,vy,vθ)
式中,vx为横向速度样本,vy为纵向速度样本,vθ为角速度样本;F(vx,vy,vθ)是在vx,vy,vθ条件下生成的轨迹的评价值,α1为距离评价参数,s(bt+1,B)是选取的机器人一个关键点b按照vx,vy,vθ条件下达到下一时刻的位置后距离对应目标关键点的距离,α2为机器人位姿夹角评价参数,γ(ω1-ω2)为机器人的位姿角度与对应外部充电器的位姿角度的夹角,α3为障碍物评价参数,μ(vx,vy,vθ)为一个(0,1)变量,当按照vx,vy,vθ条件下达到下一时刻的位置后,机器人若会碰到障碍物,μ(vx,vy,vθ)=1,否则,μ(vx,vy,vθ)=0。
如上所述的方法中,在S7中所述将机器人的充电接口与外部充电器对接,具体为:机器人到达外部充电器位置后,调整机器人的位姿,使得机器人整体能够对应到充电器各点,以实现自动充电;
所述调整机器人的位姿,包括:
对s(bt+1,B)和γ(ω1-ω2)进行归一化平滑处理:
式中,备选轨迹空间中有N条备选轨迹,则第i条轨迹,i∈{1,......,N};
对α1和α2进行动态调整:
α1=1-α2;
式中,αmax是设置的最大参数,是(0,1)范围内一个数,αmin是设置的最小参数,是(0,1)范围内一个数,t为进行移动的次数,即机器人移动的第几步,tmax为设置的最大移动次数。
如上所述的方法中,在S5中所述基于生成的每一条备选轨迹的评价值,选择最优的备选轨迹作为机器人的移动轨迹,具体为:
选取最小的评价函数值确定为最优的备选轨迹。
如上所述的方法中,所述利用机器人的最大速度、动态规划的速度间隔和角速度间隔确定机器人的速度样本,具体为:
横向速度样本:
纵向速度样本:
角速度样本:
式中,vmax为机器人的最大速度,Δv为动态规划的速度间隔,Δvθ为角速度间隔。
如上所述的方法中,在S2中所述对机器人的位置进行定位,具体为:
利用机器人自身携带的传感检测设备进行数据采集,并对数据进行融合处理,利用融合后的数据获取环境信息,定位出机器人的位置。
如上所述的方法中所述传感检测设备包括红外传感器模块和超声波传感器模块。
第二方面,本发明实施例提供一种用于机器人自动充电的路径规划装置,包括:
接收单元,用于接收机器人电量不足的提示信息;
定位单元,用于对机器人的位置进行定位;
处理单元,用于运用改进型动态窗口法构建一组机器人的备选轨迹空间;
所述处理单元还用于以机器人的位置到外部充电器的距离和位姿夹角为目标,对备选轨迹空间内每一条备选轨迹进行评价,生成每一条备选轨迹的评价值;
控制单元,用于基于生成的每一条备选轨迹的评价值,选择最优的备选轨迹作为机器人的移动轨迹,控制机器人进行移动;
判断单元,用于判断机器人的位置是否为机器人要到达的外部充电器位置;
所述控制单元还用于将机器人的充电接口与外部充电器对接,实现自动充电。
本发明实施例提供的技术方案,利用改进型动态窗口算法规划出由机器人充电座位置到外部充电器位置的优化路径,并由控制单元控制机器人调整位姿,按照优化路径到达外部充电器处。该方案易于实现,规划效率高,能够驱动机器人有效避开障碍物位置,且快速到达外部充电器位置,实现机器人的快速自动充电。
附图说明
为了更清楚地说明本发明实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明提供的用于机器人自动充电的路径规划方法的流程图;
图2为本发明提供的应用实施例的流程示意图;
图3为本发明提供的应用实施例中路径实现过程以及参数标定示意图;
图4为本发明提供的应用实施例中规划路径目标设置示意图;
图5为本发明提供的应用实施例中机器人结构几何关系示意图;
图6A、图6B为本发明提供的应用实施例中基于改进型动态窗口法机器人运动轨迹示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
图1为本发明提供的用于机器人自动充电的路径规划方法的流程图,该方法可以由用于机器人自动充电的路径规划装置来执行,该规划装置可以通过软件方式实现,配置于机器人设备中。如图1所示,本实施例的方法可以包括以下内容。
S1、接收机器人电量不足的提示信息。
S2、对机器人的位置进行定位。
在具体应用中,可以利用机器人自身携带的传感检测设备进行数据采集,并对数据进行融合处理,利用融合后的数据获取环境信息,定位出机器人的位置。所述传感检测设备通常包括红外传感器模块和超声波传感器模块。
S3、运用改进型动态窗口法构建一组机器人的备选轨迹空间。
S4、以机器人的位置到外部充电器的距离和位姿夹角为目标,对备选轨迹空间内每一条备选轨迹进行评价,生成每一条备选轨迹的评价值。
S5、基于生成的每一条备选轨迹的评价值,选择最优的备选轨迹作为机器人的移动轨迹,控制机器人进行移动。
S6、判断机器人的位置是否为机器人要到达的外部充电器位置,若为是,则执行S7,若为否,则执行S3。
S7、将机器人的充电接口与外部充电器对接,实现自动充电。
如上所述的方法中,在S3中所述运用改进型动态窗口法构建一组机器人的备选轨迹空间,包括:
确定机器人的最大速度、动态规划的速度间隔和角速度间隔;
利用机器人的最大速度、动态规划的速度间隔和角速度间隔确定机器人的速度样本;所述速度样本包括:横向速度样本、纵向速度样本和角速度样本;
基于速度样本推算机器人下一时刻的备选位置,得到当前位置到备选位置的备选轨迹,所有速度样本的组合推算出一组机器人的备选轨迹空间。
如上所述的方法中,所述基于速度样本推算机器人下一时刻的备选位置,具体为:利用以下公式和机器人当前t时刻的位置推算下一时刻t+1的备选位置;
θt+.1=θt+vθ;
xt+1=xt+vx×cos(θt+1)-vy×sin(θt+1);
yt+1=yt+vx×sin(θt+1)+vy×cos(θt+1);
式中,vx为横向速度样本,vy为纵向速度样本,vθ为角速度样本;xt、yt、θt分别为机器人当前时刻t的横向坐标、纵向坐标和方向角;xt+1、yt+1、θt+1分别为机器人下一时刻t+1的横向坐标、纵向坐标和方向角。
如上所述的方法中,对备选轨迹空间中的每一条轨迹进行评价,利用以下评价函数生成每一条轨迹的评价值;
F(vx,vy,vθ)=α1×s(bt+1,B)+α2×γ(ω1-ω2)+α3×μ(vx,vy,vθ)
式中,vx为横向速度样本,vy为纵向速度样本,vθ为角速度样本;F(vx,vy,vθ)是在vx,vy,vθ条件下生成的轨迹的评价值,α1为距离评价参数,s(bt+1,B)是选取的机器人一个关键点b按照vx,vy,vθ条件下达到下一时刻的位置后距离对应目标关键点的距离,α2为机器人位姿夹角评价参数,γ(ω1-ω2)为机器人的位姿角度与对应外部充电器的位姿角度的夹角,α3为障碍物评价参数,μ(vx,vy,vθ)为一个(0,1)变量,当按照vx,vy,vθ条件下达到下一时刻的位置后,机器人若会碰到障碍物,μ(vx,vy,vθ)=1,否则,μ(vx,vy,vθ)=0。
如上所述的方法中,在S7中所述将机器人的充电接口与外部充电器对接,具体为:机器人到达外部充电器位置后,调整机器人的位姿,使得机器人整体能够对应到充电器各点,以实现自动充电。
所述调整机器人的位姿,包括:
对s(bt+1,B)和γ(ω1-ω2)进行归一化平滑处理:
式中,备选轨迹空间中有N条备选轨迹,则第i条轨迹,i∈{1,......,N};
对α1和α2进行动态调整:
α1=1-α2;
式中,αmax是设置的最大参数,是(0,1)范围内一个数,αmin是设置的最小参数,是(0,1)范围内一个数,t为进行移动的次数,即机器人移动的第几步,tmax为设置的最大移动次数。
如上所述的方法中,在S5中所述基于生成的每一条备选轨迹的评价值,选择最优的备选轨迹作为机器人的移动轨迹,具体为:
选取最小的评价函数值确定为最优的备选轨迹。
如上所述的方法中,所述利用机器人的最大速度、动态规划的速度间隔和角速度间隔确定机器人的速度样本,具体为:
横向速度样本:
纵向速度样本:
角速度样本:
式中,vmax为机器人的最大速度,Δv为动态规划的速度间隔,Δvθ为角速度间隔。
在具体应用中,机器人在电量不足状态下,可以融合底盘充电座旁红外传感器模块和超声波传感器模块等多种传感检测设备感知的环境信息,利用改进型动态窗口算法规划出由机器人充电座到外部充电器的优化路径,并由控制单元控制机器人调整位姿,按照优化路径到达外部充电器处,实现自动充电。本发明的优点是模型易于实现,规划效率较高,适合机器人规划出最优路径,能够较为高效地到达外部充电器目标,实现快速自动充电。
下面给出的是本发明实施例提供的技术方案的一个应用实施例。图2为本发明提供的应用实施例的流程示意图,图3为本发明提供的应用实施例中路径实现过程以及参数标定示意图。参考图2、图3所示,该应用实施例具体可以包括如下步骤:
步骤1,机器人系统接收到电量不足的信息,启动机器人自动充电功能;
步骤2,进行操作环境初始化,机器人利用本身携带的红外传感器模块和超声波传感器模块等多种传感检测设备,进行数据采集,并对数据进行融合处理,利用融合后的数据获取环境信息,定位自身位置;
步骤3,运用改进型动态窗口法,根据自身位置和外部充电器(电源处)的信息,在横向速度,纵向速度,角加速度等自身的特性,构建一组备选轨迹空间;
步骤4,以自身位置到外部充电器的距离和位姿夹角为目标,对轨迹空间内每一条备选轨迹进行评价;
步骤5,选取最优的轨迹,控制机器人进行移动,判断到达的位置是否到外部充电器(电源处),若是,则执行步骤6,若否,则执行步骤3;
步骤6,机器人底盘的充电座到达外部充电器(电源处),实现自动充电。
图4为本发明提供的应用实施例中规划路径目标设置示意图,图5为本发明提供的应用实施例中机器人结构几何关系示意图,图6A、图6B为本发明提供的应用实施例中基于改进型动态窗口法机器人运动轨迹示意图。参考图4、图5、图6A、图6B所示,如上所述的方法中,所述利用改进型动态窗口算法,具体包括:
步骤301,确定机器人最大速度vmax,以及动态规划的速度间隔Δv以及角速度间隔Δvθ;
步骤402,利用机器人最大速度vmax以及动态规划的速度间隔Δv以及角速度间隔Δvθ,确定速度样本;所述速度样本包括:横向速度样本、纵向速度样本和角速度样本;
横向速度样本:
纵向速度样本:
角速度样本:
步骤403,对于每一速度样本(vx,vy,vθ),利用以下公式和当前t时刻的位置推算下一时刻t+1的备选位置,得到当前位置到备选位置的备选轨迹,所有速度样本的组合计算出一组备选轨迹空间;
θt+1=θt+vθ;
xt+1=xt+vx×cos(θt+1)-vy×sin(θt+1);
yt+1=yt+vx×sin(θt+1)+vy×cos(θt+1);
步骤404,将机器人视为一个刚体结构,即机器人各点具备一定几何关系,机器人充电要利用本身的几个关键点,一个关键点到达下一刻位置后,机器人其他各点均利用几何关系到达对应位置,机器人各个点最终都要分别准确的到达目标位置,即机器人位姿要准确。
步骤405,对备选轨迹空间中的每一条轨迹进行评价,利用以下评价函数生成每一条轨迹的评价值;
F(vx,vy,vθ)=α1×s(bt+1,B)+α2×γ(ω1-ω2)+α3×μ(vx,vy,vθ)
其中,F(vx,vy,vθ)是在vx,vy,vθ条件下生成的轨迹的评价值,α1为距离评价参数,s(bt+1,B)是选取的机器人一个关键点b按照vx,vy,vθ条件下达到下一时刻的位置后距离对应目标关键点的距离,α2为机器人位姿夹角评价参数,γ(ω1-ω2)为机器人的位姿角度与对应外部充电器的位姿角度的夹角(该夹角处理后表示为[0,360)范围内的一个数字),α3为障碍物评价参数,设置为一个极大值,μ(vx,vy,vθ)为一个(0,1)变量,当按照vx,vy,vθ条件下达到下一时刻的位置后,机器人若会碰到障碍物,μ(vx,vy,vθ)=1;否则,μ(vx,vy,vθ)=0,同时设定:当按照vx,vy,vθ条件下达到下一时刻的位置后,机器人的红外接收器不在外部充电器的红外发射器极限夹角范围内,即使得机器人的红外接收器接收不到外部充电器的红外发射器发射的信号,也视作机器人进入障碍物区域,该重要设定使得机器人能够持续获取外部充电器的位置信息。
步骤406,根据实际需求,希望机器人先快速达到外部充电器位置,然后不断调整位姿,使得机器人整体能够对应到充电器各点,以实现自动充电,所以对动态窗口算法进行一下改进:
1)对s(bt+1,B)和γ(ω1-ω2)进行归一化平滑处理,备选轨迹空间中有N条备选轨迹,则第i条轨迹,i∈{1,......,N};
2)希望机器人先快速达到外部充电器位置,然后不断调整位姿,所以对α1和α2进行动态调整;
α1=1-α2;
其中αmax是设置的最大参数,是(0,1)范围内一个数,αmin是设置的最小参数,是(0,1)范围内一个数,t为进行移动的次数,即机器人移动的第几步,tmax为设置的最大移动次数。
步骤407,根据评价函数值,选取最小的评价函数值确定最优的轨迹。
本发明实施例提供的用于机器人自动充电的路径规划装置包括:接收单元、定位单元、处理单元、控制单元和判断单元。其中,接收单元用于接收机器人电量不足的提示信息;定位单元用于对机器人的位置进行定位;处理单元用于运用改进型动态窗口法构建一组机器人的备选轨迹空间;所述处理单元还用于以机器人的位置到外部充电器的距离和位姿夹角为目标,对备选轨迹空间内每一条备选轨迹进行评价,生成每一条备选轨迹的评价值;控制单元用于基于生成的每一条备选轨迹的评价值,选择最优的备选轨迹作为机器人的移动轨迹,控制机器人进行移动;判断单元用于判断机器人的位置是否为机器人要到达的外部充电器位置;所述控制单元还用于将机器人的充电接口与外部充电器对接,实现自动充电。
本实施例的用于机器人自动充电的路径规划可以用于执行图1所示方法实施例的方法,其实现原理和所要达到的技术效果类似,在此不再赘述。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (10)
1.一种用于机器人自动充电的路径规划方法,其特征在于,包括:
S1、接收机器人电量不足的提示信息;
S2、对机器人的位置进行定位;
S3、运用改进型动态窗口法构建一组机器人的备选轨迹空间;
S4、以机器人的位置到外部充电器的距离和位姿夹角为目标,对备选轨迹空间内每一条备选轨迹进行评价,生成每一条备选轨迹的评价值;
S5、基于生成的每一条备选轨迹的评价值,选择最优的备选轨迹作为机器人的移动轨迹,控制机器人进行移动;
S6、判断机器人的位置是否为机器人要到达的外部充电器位置,若为是,则执行S7,若为否,则执行S3;
S7、将机器人的充电接口与外部充电器对接,实现自动充电。
2.如权利要求1所述的方法,其特征在于,在S3中所述运用改进型动态窗口法构建一组机器人的备选轨迹空间,包括:
确定机器人的最大速度、动态规划的速度间隔和角速度间隔;
利用机器人的最大速度、动态规划的速度间隔和角速度间隔确定机器人的速度样本;所述速度样本包括:横向速度样本、纵向速度样本和角速度样本;
基于速度样本推算机器人下一时刻的备选位置,得到当前位置到备选位置的备选轨迹,所有速度样本的组合推算出一组机器人的备选轨迹空间。
3.如权利要求2所述的方法,其特征在于,所述基于速度样本推算机器人下一时刻的备选位置,具体为:利用以下公式和机器人当前t时刻的位置推算下一时刻t+1的备选位置;
θt+1=θt+vθ;
xt+1=xt+vx×cos(θt+1)-vy×sin(θt+1);
yt+1=yt+vx×sin(θt+1)+vy×cos(θt+1);
式中,vx为横向速度样本,vy为纵向速度样本,vθ为角速度样本;xt、yt、θt分别为机器人当前时刻t的横向坐标、纵向坐标和方向角;xt+1、yt+1、θt+1分别为机器人下一时刻t+1的横向坐标、纵向坐标和方向角。
4.如权利要求3所述的方法,其特征在于,对备选轨迹空间中的每一条轨迹进行评价,利用以下评价函数生成每一条轨迹的评价值;
F(vx,vy,vθ)=α1×s(bt+1,B)+α2×γ(ω1-ω2)+α3×μ(vx,vy,vθ)
式中,vx为横向速度样本,vy为纵向速度样本,vθ为角速度样本;F(vx,vy,vθ)是在vx,vy,vθ条件下生成的轨迹的评价值,α1为距离评价参数,s(bt+1,B)是选取的机器人一个关键点b按照vx,vy,vθ条件下达到下一时刻的位置后距离对应目标关键点的距离,α2为机器人位姿夹角评价参数,γ(ω1-ω2)为机器人的位姿角度与对应外部充电器的位姿角度的夹角,α3为障碍物评价参数,μ(vx,vy,vθ)为一个(0,1)变量,当按照vx,vy,vθ条件下达到下一时刻的位置后,机器人若会碰到障碍物,μ(vx,vy,vθ)=1,否则,μ(vx,vy,vθ)=0。
5.如权利要求4所述的方法,其特征在于,在S7中所述将机器人的充电接口与外部充电器对接,具体为:机器人到达外部充电器位置后,调整机器人的位姿,使得机器人整体能够对应到充电器各点,以实现自动充电;
所述调整机器人的位姿,包括:
对s(bt+1,B)和γ(ω1-ω2)进行归一化平滑处理:
式中,备选轨迹空间中有N条备选轨迹,则第i条轨迹,i∈{1,......,N};
对α1和α2进行动态调整:
α1=1-α2;
式中,αmax是设置的最大参数,是(0,1)范围内一个数,αmin是设置的最小参数,是(0,1)范围内一个数,t为进行移动的次数,即机器人移动的第几步,tmax为设置的最大移动次数。
6.如权利要求5所述的方法,其特征在于,在S5中所述基于生成的每一条备选轨迹的评价值,选择最优的备选轨迹作为机器人的移动轨迹,具体为:
选取最小的评价函数值确定为最优的备选轨迹。
7.如权利要求2所述的方法,其特征在于,所述利用机器人的最大速度、动态规划的速度间隔和角速度间隔确定机器人的速度样本,具体为:
横向速度样本:
纵向速度样本:
角速度样本:
式中,vmax为机器人的最大速度,Δv为动态规划的速度间隔,Δvθ为角速度间隔。
8.如权利要求1所述的方法,其特征在于,在S2中所述对机器人的位置进行定位,具体为:
利用机器人自身携带的传感检测设备进行数据采集,并对数据进行融合处理,利用融合后的数据获取环境信息,定位出机器人的位置。
9.如权利要求8所述的方法,其特征在于,所述传感检测设备包括红外传感器模块和超声波传感器模块。
10.一种用于机器人自动充电的路径规划装置,其特征在于,包括:
接收单元,用于接收机器人电量不足的提示信息;
定位单元,用于对机器人的位置进行定位;
处理单元,用于运用改进型动态窗口法构建一组机器人的备选轨迹空间;
所述处理单元还用于以机器人的位置到外部充电器的距离和位姿夹角为目标,对备选轨迹空间内每一条备选轨迹进行评价,生成每一条备选轨迹的评价值;
控制单元,用于基于生成的每一条备选轨迹的评价值,选择最优的备选轨迹作为机器人的移动轨迹,控制机器人进行移动;
判断单元,用于判断机器人的位置是否为机器人要到达的外部充电器位置;
所述控制单元还用于将机器人的充电接口与外部充电器对接,实现自动充电。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910508730.5A CN110162063A (zh) | 2019-06-12 | 2019-06-12 | 一种用于机器人自动充电的路径规划方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910508730.5A CN110162063A (zh) | 2019-06-12 | 2019-06-12 | 一种用于机器人自动充电的路径规划方法和装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110162063A true CN110162063A (zh) | 2019-08-23 |
Family
ID=67628770
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910508730.5A Pending CN110162063A (zh) | 2019-06-12 | 2019-06-12 | 一种用于机器人自动充电的路径规划方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110162063A (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110955241A (zh) * | 2019-11-22 | 2020-04-03 | 深圳市优必选科技股份有限公司 | 移动机器人避障方法、装置、移动机器人及存储介质 |
CN110955242A (zh) * | 2019-11-22 | 2020-04-03 | 深圳市优必选科技股份有限公司 | 机器人导航方法、系统、机器人及存储介质 |
CN111123934A (zh) * | 2019-12-25 | 2020-05-08 | 深圳深岚视觉科技有限公司 | 轨迹评估方法、轨迹评估装置及移动机器人 |
CN111142530A (zh) * | 2019-12-31 | 2020-05-12 | 深圳前海达闼云端智能科技有限公司 | 一种机器人运行轨迹的确定方法、机器人和存储介质 |
CN111665847A (zh) * | 2020-06-24 | 2020-09-15 | 上海应用技术大学 | 一种基于模糊逻辑的动态窗口避障算法 |
CN111752295A (zh) * | 2019-08-27 | 2020-10-09 | 广州极飞科技有限公司 | 无人机飞行轨迹规划方法及相关装置 |
US20210101293A1 (en) * | 2019-10-08 | 2021-04-08 | Toyota Jidosha Kabushiki Kaisha | Autonomous mobile robot and control program for autonomous mobile robot |
CN113156944A (zh) * | 2021-03-28 | 2021-07-23 | 西北工业大学 | 一种室内移动机器人充电路径规划与运动控制算法 |
CN113325833A (zh) * | 2021-04-07 | 2021-08-31 | 浙江大学 | 一种移动机器人自动回充电的方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101738195A (zh) * | 2009-12-24 | 2010-06-16 | 厦门大学 | 基于环境建模与自适应窗口的移动机器人路径规划方法 |
CN103645733A (zh) * | 2013-12-02 | 2014-03-19 | 江苏建威电子科技有限公司 | 自寻充电机器人及其自寻充电系统和方法 |
CN106406320A (zh) * | 2016-11-29 | 2017-02-15 | 重庆重智机器人研究院有限公司 | 机器人路径规划方法及规划路线的机器人 |
CN106980320A (zh) * | 2017-05-18 | 2017-07-25 | 上海思岚科技有限公司 | 机器人充电方法及装置 |
CN107703948A (zh) * | 2017-11-14 | 2018-02-16 | 上海理工大学 | 基于自适应动态窗口的移动机器人局部动态路径规划方法 |
CN108375976A (zh) * | 2018-01-22 | 2018-08-07 | 中国民用航空飞行学院 | 一种服务机器人导航方法及系统 |
CN108733062A (zh) * | 2018-06-25 | 2018-11-02 | 山东大学 | 家庭陪护机器人自主充电系统及方法 |
US20190094866A1 (en) * | 2017-09-22 | 2019-03-28 | Locus Robotics Corporation | Dynamic window approach using optimal reciprocal collision avoidance cost-critic |
-
2019
- 2019-06-12 CN CN201910508730.5A patent/CN110162063A/zh active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101738195A (zh) * | 2009-12-24 | 2010-06-16 | 厦门大学 | 基于环境建模与自适应窗口的移动机器人路径规划方法 |
CN103645733A (zh) * | 2013-12-02 | 2014-03-19 | 江苏建威电子科技有限公司 | 自寻充电机器人及其自寻充电系统和方法 |
CN106406320A (zh) * | 2016-11-29 | 2017-02-15 | 重庆重智机器人研究院有限公司 | 机器人路径规划方法及规划路线的机器人 |
CN106980320A (zh) * | 2017-05-18 | 2017-07-25 | 上海思岚科技有限公司 | 机器人充电方法及装置 |
US20190094866A1 (en) * | 2017-09-22 | 2019-03-28 | Locus Robotics Corporation | Dynamic window approach using optimal reciprocal collision avoidance cost-critic |
CN107703948A (zh) * | 2017-11-14 | 2018-02-16 | 上海理工大学 | 基于自适应动态窗口的移动机器人局部动态路径规划方法 |
CN108375976A (zh) * | 2018-01-22 | 2018-08-07 | 中国民用航空飞行学院 | 一种服务机器人导航方法及系统 |
CN108733062A (zh) * | 2018-06-25 | 2018-11-02 | 山东大学 | 家庭陪护机器人自主充电系统及方法 |
Non-Patent Citations (3)
Title |
---|
HAIQIANG ZHANG,等: "Autonomous Indoor Exploration of Mobile Robots based on Door-Guidance and Improved Dynamic Window Approach", 《PROCEEDINGS OF THE 2009 IEEE INTERNATIONAL CONFERENCE ON ROBOTICS AND BIOMIMETICS》 * |
李宁: "面向家庭环境的移动机器人局部路径规划算法研究", 《万方硕士学位论文》 * |
黄辰: "基于智能优化算法的移动机器人路径规划与定位方法研究", 《中国博士学位论文全文数据库 信息科技辑》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111752295A (zh) * | 2019-08-27 | 2020-10-09 | 广州极飞科技有限公司 | 无人机飞行轨迹规划方法及相关装置 |
CN111752295B (zh) * | 2019-08-27 | 2021-09-10 | 广州极飞科技股份有限公司 | 无人机飞行轨迹规划方法及相关装置 |
US20210101293A1 (en) * | 2019-10-08 | 2021-04-08 | Toyota Jidosha Kabushiki Kaisha | Autonomous mobile robot and control program for autonomous mobile robot |
US11642791B2 (en) * | 2019-10-08 | 2023-05-09 | National University Corporation Shizuoka University | Autonomous mobile robot and control program for autonomous mobile robot |
CN110955241A (zh) * | 2019-11-22 | 2020-04-03 | 深圳市优必选科技股份有限公司 | 移动机器人避障方法、装置、移动机器人及存储介质 |
CN110955242A (zh) * | 2019-11-22 | 2020-04-03 | 深圳市优必选科技股份有限公司 | 机器人导航方法、系统、机器人及存储介质 |
CN111123934A (zh) * | 2019-12-25 | 2020-05-08 | 深圳深岚视觉科技有限公司 | 轨迹评估方法、轨迹评估装置及移动机器人 |
CN111142530A (zh) * | 2019-12-31 | 2020-05-12 | 深圳前海达闼云端智能科技有限公司 | 一种机器人运行轨迹的确定方法、机器人和存储介质 |
CN111665847A (zh) * | 2020-06-24 | 2020-09-15 | 上海应用技术大学 | 一种基于模糊逻辑的动态窗口避障算法 |
CN113156944A (zh) * | 2021-03-28 | 2021-07-23 | 西北工业大学 | 一种室内移动机器人充电路径规划与运动控制算法 |
CN113325833A (zh) * | 2021-04-07 | 2021-08-31 | 浙江大学 | 一种移动机器人自动回充电的方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110162063A (zh) | 一种用于机器人自动充电的路径规划方法和装置 | |
CN101976079B (zh) | 智能导航控制系统及方法 | |
CN111693050B (zh) | 基于建筑信息模型的室内中大型机器人导航方法 | |
CN109074168A (zh) | 无人机的控制方法、设备和无人机 | |
CN104750115B (zh) | 一种移动设备的激光主动式导航系统及导航方法 | |
CN106527424A (zh) | 移动机器人及移动机器人的导航方法 | |
CN106814739A (zh) | 一种移动机器人回充控制系统及控制方法 | |
CN206684574U (zh) | 一种移动机器人回充控制系统 | |
CN112928799B (zh) | 基于激光测量的移动机器人自动对接充电方法 | |
CN105867383A (zh) | 一种usv自主避碰控制的方法 | |
CN104765368A (zh) | 一种基于模糊自适应算法的无人艇航向航速协同控制方法 | |
CN103940025B (zh) | 一种空调风门控制方法、一种遥控器及空调器 | |
CN106873608A (zh) | 一种半潜式小型无人艇集成控制系统 | |
CN106527432A (zh) | 基于模糊算法和二维码自矫正的室内移动机器人协作系统 | |
CN206833250U (zh) | 一种基于激光雷达的无人驾驶侦查小车 | |
CN104049634A (zh) | 基于Camshift算法的智能体模糊动态避障方法 | |
CN109240091A (zh) | 一种基于强化学习的水下机器人控制方法及其进行跟踪的控制方法 | |
CN106527439A (zh) | 一种运动控制方法和装置 | |
CN107255339A (zh) | 基于终端设备的空调控制方法、终端设备及存储介质 | |
CN111746728B (zh) | 一种基于强化学习的新型水上清洁机器人及控制方法 | |
CN111090284B (zh) | 自行走设备返回基站的方法及自行走设备 | |
CN204423154U (zh) | 一种基于自主导航的自动充电玩具机器人 | |
CN106708087A (zh) | 一种无人机移动控制系统及其控制方法 | |
CN110032213A (zh) | 机器人跟随系统及机器人跟随方法 | |
CN106767737A (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190823 |
|
RJ01 | Rejection of invention patent application after publication |