CN112650234A - 一种双足机器人的路径规划方法 - Google Patents
一种双足机器人的路径规划方法 Download PDFInfo
- Publication number
- CN112650234A CN112650234A CN202011491208.XA CN202011491208A CN112650234A CN 112650234 A CN112650234 A CN 112650234A CN 202011491208 A CN202011491208 A CN 202011491208A CN 112650234 A CN112650234 A CN 112650234A
- Authority
- CN
- China
- Prior art keywords
- node
- sub
- robot
- point
- cost
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 28
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 31
- 238000011156 evaluation Methods 0.000 claims abstract description 10
- 230000008569 process Effects 0.000 claims abstract description 7
- 238000001914 filtration Methods 0.000 claims abstract description 4
- 210000002683 foot Anatomy 0.000 claims description 25
- 210000002414 leg Anatomy 0.000 claims description 15
- 230000004888 barrier function Effects 0.000 claims description 12
- 238000005070 sampling Methods 0.000 claims description 12
- 238000006243 chemical reaction Methods 0.000 claims description 11
- 238000004364 calculation method Methods 0.000 claims description 9
- 230000008859 change Effects 0.000 claims description 9
- 230000005021 gait Effects 0.000 claims description 8
- 210000000544 articulatio talocruralis Anatomy 0.000 claims description 7
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 238000004088 simulation Methods 0.000 claims description 6
- 230000002093 peripheral effect Effects 0.000 claims description 5
- 206010034701 Peroneal nerve palsy Diseases 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 239000010931 gold Substances 0.000 claims description 3
- 229910052737 gold Inorganic materials 0.000 claims description 3
- 230000009191 jumping Effects 0.000 claims description 3
- 238000013507 mapping Methods 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 2
- 210000004394 hip joint Anatomy 0.000 claims description 2
- 238000012216 screening Methods 0.000 claims description 2
- 230000004927 fusion Effects 0.000 abstract 1
- 238000005265 energy consumption Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
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/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/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- 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/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)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种双足机器人的路径规划方法,使用基于多源传感器RGBD的orbslam2建立3D稠密点云图,并使用Octomap进行压缩滤除地面信息。然后通过2D投影生成占据格地图,最后利用代价地图Costmap加障碍层,用改进的D*和DwA进行全局和局部路径规划导航实时避障。本方法采用全局与局部路径规划方法的融合,通过在D*算法的子节点实际代价值中加入角度评价,减少不必要的转弯过程,同时通过限制子节点的选取,使路线规划更加安全可靠。
Description
技术领域
本发明涉及机器人领域,尤其涉及一种双足机器人的路径规划方法。
背景技术
移动机器人现有的路径规划根据地图环境和障碍物类型等可以分为全局路径规划和局部路径规划。全局路径规划主要用于规划机器人的路径,局部路径规划主要用于避障。D*算法为常用的局部路径规划算法,但是在避障中存在一定的缺点,D*算法是一种长度优先的算法并且向周围8个子节点进行扩展搜索,生成的路径会产生损坏路径质量的不必要转弯,在实际导航过程中,这些不必要的转弯会增加移动机器人***的能耗和时间,长度优先也导致生成的路径十分贴近障碍物,某些时候会从两个“危险”障碍物之间穿过,对实际应用追求的安全性和低能耗考虑的并不周到。同时一般的算法一般是基于轮式机器人所编写的,要在双足机器人中实现,需要进行一定的转换,并不容易。
发明内容
本发明目的在于针对现有技术的不足,提出一种双足机器人的路径规划方法。
本发明的目的是通过以下技术方案来实现的:一种双足机器人的路径规划方法,包括以下步骤:
步骤一,构建地图
基于多源传感器RGBD的orbslam2建立3D稠密点云图,基于随机一致性采样(RANSAC)进行点云的地面滤除,然后将Octomap进行2D投影生成占据栅格地图,最后利用Costmap代价地图叠加动态障碍层作为最终的导航地图。
步骤二,路径规划
采用改进的基于启发式的D*算法,算法在选取子节点时,根据父节点与周围节点的代价函数C(X,Y)值,连续计算两层父子节点值,筛选掉靠近障碍物的子节点,防止算法生成路径贴近障碍物。同时在父节点周围扩展子节点,计算扩展子节点代价值时,根据角度余弦值进行修正,优先选择扩展使得路径平滑的子节点,减少路径转弯次数。
在根据步骤一构建的地图和目标位置,规划一条机器人到达目标位置的全局路径(只考虑工作空间的几何约束,不考虑机器人的运动学模型和约束)。
步骤三,避障规划
采用动态窗口算法,根据所得到的实时传感器测量信息计算最佳的速度指令,调整局部路径以避免发生碰撞。具体过程为:在机器人控制空间(dx,dy,dθ)中离散采样,对于每个采样速度,从机器人的当前状态执行正向移动模拟,以预测如果在某时间段内应用采样速度将会发生什么。然后从以下方面来评价正向移动模拟产生的每个轨迹:接近障碍物,接近目标,接近全局路径和速度。并且放弃非法轨迹,所述非法轨迹为与障碍物相撞的轨迹,选择最高得分的轨迹,并将最佳速度指令发送到下位机的移动基座。然后重复轨迹评价直到轨迹空间遍历完成。
步骤四,轨迹生成
将机器人模型转化为线性倒立摆模型,确定每步之间落脚点信息的转换关系,然后进行步态规划,包括实际落脚点的求算、质心轨迹规划、踝关节轨迹规划,以及逆运动学求算关节角度。根据机器人的运动学模型和约束,发送控制命令给机器人下位机,将可行的直线路径转化为可行的脚印轨迹。
进一步地,所述步骤2中,改进的基于启发式的D*算法具体步骤如下:
S1,在步骤一构建的地图中确定起始点S与目标点G的位置,将G点加入open表中,同时置空open表与close表。
S2,判断open表是否为空,若为空,表示目标不可达。
S3,若open表不为空,将当前节点作为父节点,将其周围的所有子节点全部放入open表中。
S4,将代价函数值最小的子节点作为下一节点next,并将节点next放入closed表中,若节点next为目标点,则找到路径,算法结束。若并非目标点,开始以节点next为父节点扩展周围子节点sub。
S5,计算节点next与节点sub之间的路径开销C(next,sub),当开销为无穷大时,表明节点next周围存在障碍,则将节点next从close表中剔除,并按照代价函数值从小到大顺序再从open表中选择下一个子节点作为下一节点next,并返回S4进行计算。
S6,当节点next与节点sub之间的路径开销C(next,sub)均不为无穷大时,判断节点sub是否在open表中,若在,则计算节点sub的代价函数值,并与节点next的代价函数值进行比较。当节点sub的代价函数值小于节点next的代价函数值,则直接跳到S7,反之则舍弃节点sub。若节点sub不在open表中,继续判断是否在close表中,如果不在,则将节点sub***open表中,然后执行S7。若节点sub在节点open表中,判断节点sub与节点next代价函数的大小关系,若节点sub代价函数值小于节点next的代价函数值,将节点sub从Close表移至Open表,并更新Close表代价值,反之舍弃节点sub。
S7,更新Open表中的代价值,并将指针指向Next。然后跳到S2。
进一步地,在子节点的实际代价值中加入角度评价从而减少不必要的转弯过程。若设父节点到当前节点的方向为向量A方向,当前节点到子节点的方向为向量B方向,角度偏移量的取值取决于向量A与向量B的夹角。
gnew(n)=Kgold(n)
K=-cos(∠AB)+2
其中,gold(n)为D*算法中的距离代价,gnew(n)为改进后的D*算法中的距离代价,K为角度偏移系数,用于根据角度的变化来改变距离代价的值,∠AB为向量A与向量B的夹角。
进一步地,所述步骤四中,增加了双足机器人的关系映射,轨迹生成包括以下步骤:
S1建立倒立摆模型,同时将模型与机器人运动对应。假设机器人质心始终固定在机器人身上某处(实践中取两髋关节连线的中点),对应线性倒立摆中的质点M。倒立摆的支撑点同样对应机器人支撑脚上位置固定的一个点(一般取踝关节中心点在脚面上的垂直投影处)。
S2,确定每步之间落脚点信息的转换关系。
当机器人开始迈完一步,开始新一步时,存在如下转换关系:
当前一步支撑脚转换为下一步摆动脚起点,当前一步摆动脚终点(实际落脚点)转换为下一步支撑脚。
S3,步态规划,包括以下步骤
S31,实际落脚点求算
在实际步态规划中,机器人的目标落脚点位置P用步行参数(Sx Sy Sθ)描述,分别对应步长,步宽和步行方向,假设此时目标落脚点为Pn,下一时刻目标落脚点为Pn+1,两者满足以下关系:
S32质心轨迹求算
Tsup为双足机器人支撑脚切换时间;
得到双足支撑期质心始、末状态后,即可根据样条函数插值求双足支撑期质心轨迹。双足支撑期质心末状态,也就是接下来单足支撑期的质心始状态。运用轮式运动学模型,将整车线位移映射到双足机器人质心线位移上,但是在转换系数上除二,角速度以步行方向在单位时间ΔT的改变来实现。
S33踝关节轨迹规划
根据摆动脚起点以及求算得到的摆动脚终点(实际落脚点)即可以在x、y方向上规划机器人的摆动脚的运动,其运动由样条插值得到。
进一步地,双足机器人的最大步长为Sxm=12。直立行走情况下,Sy可固定设置为两脚自然状态下的间距,为保证舵机性能和防止结构干涉,步行方向的改变幅度不能过大,限制为正负30度以内。
本发明的有益效果:与传统路径规划相比,本发明的方法通过将角度偏移量加入评价机制中,优先选择使得路径偏转少的子节点进行扩展,这样可以有效减少多次转弯的情况。同时通过f值判断周围子节点中是否存在障碍物,舍弃存在障碍物或者是靠近障碍物的子节点,从而避免贴近障碍物行走的不安全状况发生。
附图说明
图1为双足机器人路径规划方法的流程图。
图2为改进的D*算法流程图。
具体实施方式
以下结合附图对本发明具体实施方式作进一步详细说明。
如图1所示,本发明提供的一种为了使本发明的目的和技术方案更加清晰和便于理解,以下结合附图和实施例,对本发明进行进一步的详细说明,此处描述的具体实施例仅用于解释本发明,并非用于限定本发明。本发明具体步骤如下:
1、构建地图
基于多源传感器RGBD的orbslam2建立3D稠密点云图,基于随机一致性采样(RANSAC)进行点云的地面滤除,然后将Octomap进行2D投影生成占据栅格地图,最后利用代价地图Costmap加障碍层,作为最终的导航地图。
2、路径规划
采用改进的D*算法进行路径规划,改进的D*算法主要基于两个方面进行改进,一个是基于扩展子节点代价值的改变,一个是基于子节点的选取。算法在选取子节点时,根据父节点与周围节点的代价函数C(X,Y)值,连续计算两层父子节点值,筛选掉靠近障碍物的子节点,防止算法生成路径贴近障碍物。
(1)D*算法采用如下的评估函数来进行计算
f(n)=g(n)+h(n)
其中g(n)是基本项,代表终点到当前节点的实际成本;h(n)为启发项,代表当前节点到起点的最小成本估计值;n为当前节点。当通过子节点在父节点周围进行扩展的时候,计算下一扩展节点代价时,将偏转角度作为评价标准加入评价机制中,优先选择使得路径偏转少的子节点进行扩展,这样可以有效减少多次转弯的情况。
本发明引入偏转角∠AB的概念,将父节点到当前节点的方向设为向量A的方向,当前节点到子节点的方向作为向量B的方向,偏转角为向量A与向量B的夹角。
gnew(n)=Kgold(n)
K=-cos(∠AB)+2
其中,gold(n)为D*算法中的距离代价,gnew(n)为改进后的D*算法中的距离代价,K为角度偏移系数,用于根据角度的变化来改变距离代价的值,∠AB为向量A与向量B的夹角。
(2)子节点的选取。
D*算法扩展当前节点的8个邻居子节点并且这8个节点是同时加入openlist中,没有先后顺序。同时扩展的8个子节点会存在障碍物,也会存在贴近障碍物行进的情况。改进的算法中通过f值判断周围子节点中是否存在障碍物,舍弃存在障碍物或者是靠近障碍物的子节点,从而避免贴近障碍物行走的不安全状况发生。
主要步骤为:
S1,在地图中确定起始点S与目标点G的位置,将G点加入open表中,同时置空open表与close表。
S2,判断open表是否为空,若为空,表示目标不可达。
S3,若open表不为空,将当前节点作为父节点,将其周围的8个子节点全部放入open表中。
S4,将代价函数f值最小的子节点作为下一节点next,并将节点next放入closed表中,若节点next为目标点,则找到路径,算法结束。若并非目标点,开始以节点next为父节点扩展周围子节点sub.
S5,计算子节点next与周围子节点sub之间的路径开销C(next,sub),当开销为无穷大时,表明节点next周围存在障碍,将此节点next从close表中剔除,并f值从小到大顺序再从open表中选择下一个子节点作为下一节点next,并返回S4进行计算。
S6,当节点next与节点sub之间的路径开销C(next,sub)均不为无穷大时,判断节点sub是否在open表中,若在,则计算节点sub的代价函数f值,并与节点next的f值进行比较。当节点sub的f值小于节点next的f值,则直接跳到S7,反之则舍弃节点sub。若节点sub不在open表中,继续判断是否在close表中,如果不在,则将节点sub***open表中,然后执行S7。若节点sub在节点open表中,判断节点sub与节点next代价函数的大小关系,若节点sub代价函数值小于节点next的代价函数值,将节点sub从Close表移至Open表,并更新Close表代价值,反之舍弃节点sub。
S7更新Open表中的代价值,并将指针指向Next。然后跳到S2。
3、避障规划
采用DWA动态窗口算法进行局部路径规划,根据所得到的实时传感器测量信息计算最佳的速度指令,调整局部路径以避免发生碰撞。具体过程为:在机器人控制空间(dx,dy,dθ)中离散采样,对于每个采样速度,从机器人的当前状态执行正向移动模拟,以预测如果在某时间段内应用采样速度将会发生什么。然后从以下方面来评价正向移动模拟产生的每个轨迹:接近障碍物,接近目标,接近全局路径和速度。并且放弃非法轨迹,所述非法轨迹为与障碍物相撞的轨迹,选择最高得分的轨迹,并将最佳速度指令发送到下位机的移动基座。然后重复轨迹评价直到轨迹空间遍历完成。
4、轨迹生成,为了使算法落地更加方便,增加了双足机器人的关系映射,轨迹生成包括以下步骤:
S1,建立倒立摆模型,同时将模型与机器人运动对应。
常见的移动式机器人都是轮式或者是麦克纳姆轮式的,机器人坐标递推公式为:
x=x+vtΔtcos(θt)
y=y+vtΔtsin(θt)
θt=θt+ωtΔt
其中,x表示轮式机器人位置横坐标,y表示轮式机器人位置纵坐标,θt表示轮式机器人偏转角度。vt表示轮式机器人线速度,wt表示轮式机器人角速度,Δt表示时间间隔。
S2,确定每步之间落脚点信息的转换关系。
当机器人开始迈完一步,开始新一步时,存在如下转换关系:
当前一步支撑脚转换为下一步摆动脚起点,当前一步摆动脚终点(实际落脚点)转换为下一步支撑脚。
S3,步态规划,包括以下步骤:
S31,实际落脚点求算
实际步态规划中,机器人的目标落脚点位置P用步行参数(Sx Sy Sθ)描述,分别对应步长,步宽和步行方向,假设此时目标落脚点为Pn下一时刻目标落脚点为Pn+1,两者满足以下关系:
S32质心轨迹求算:
Tsup为双足机器人支撑脚切换时间;
得到双足支撑期质心始、末状态后,即可根据样条函数插值求双足支撑期质心轨迹。双足支撑期质心末状态,也就是接下来单足支撑期的质心始状态。运用轮式运动学模型,将整车线位移映射到双足机器人质心线位移上,但是在转换系数上除二,角速度以步行方向在单位时间ΔT的改变来实现。
S33踝关节轨迹规划
根据摆动脚起点以及求算得到的摆动脚终点(实际落脚点)即可以在x、y方向上规划机器人的摆动脚的运动,其运动由样条插值得到。
根据机器人的运动学模型和约束,发送适当的控制命令给机器人下位机,将可行的直线路径转化为可行的脚印轨迹。
上述实施例用来解释说明本发明,而不是对本发明进行限制,在本发明的精神和权利要求的保护范围内,对本发明作出的任何修改和改变,都落入本发明的保护范围。
Claims (5)
1.一种双足机器人的路径规划方法,其特征在于,包括以下步骤:
步骤一,构建地图
基于多源传感器RGBD的orbslam2建立3D稠密点云图,基于随机一致性采样(RANSAC)进行点云的地面滤除,然后将Octomap进行2D投影生成占据栅格地图,最后利用Costmap代价地图叠加动态障碍层作为最终的导航地图。
步骤二,路径规划
采用改进的基于启发式的D*算法,算法在选取子节点时,根据父节点与周围节点的代价函数C(X,Y)值,连续计算两层父子节点值,筛选掉靠近障碍物的子节点,防止算法生成路径贴近障碍物。同时在父节点周围扩展子节点,计算扩展子节点代价值时,根据角度余弦值进行修正,优先选择扩展使得路径平滑的子节点,减少路径转弯次数。
在根据步骤一构建的地图和目标位置,规划一条机器人到达目标位置的全局路径(只考虑工作空间的几何约束,不考虑机器人的运动学模型和约束)。
步骤三,避障规划
采用动态窗口算法,根据所得到的实时传感器测量信息计算最佳的速度指令,调整局部路径以避免发生碰撞。具体过程为:在机器人控制空间(dx,dy,dθ)中离散采样,对于每个采样速度,从机器人的当前状态执行正向移动模拟,以预测如果在某时间段内应用采样速度将会发生什么。然后从以下方面来评价正向移动模拟产生的每个轨迹:接近障碍物,接近目标,接近全局路径和速度。并且放弃非法轨迹,所述非法轨迹为与障碍物相撞的轨迹,选择最高得分的轨迹,并将最佳速度指令发送到下位机的移动基座。然后重复轨迹评价直到轨迹空间遍历完成。
步骤四,轨迹生成
将机器人模型转化为线性倒立摆模型,确定每步之间落脚点信息的转换关系,然后进行步态规划,包括实际落脚点的求算、质心轨迹规划、踝关节轨迹规划,以及逆运动学求算关节角度。根据机器人的运动学模型和约束,发送控制命令给机器人下位机,将可行的直线路径转化为可行的脚印轨迹。
2.根据权利要求1中所述的一种双足机器人的路径规划方法,其特征在于,所述步骤2中,改进的基于启发式的D*算法具体步骤如下:
S1,在步骤一构建的地图中确定起始点S与目标点G的位置,将G点加入open表中,同时置空open表与close表。
S2,判断open表是否为空,若为空,表示目标不可达。
S3,若open表不为空,将当前节点作为父节点,将其周围的所有子节点全部放入open表中。
S4,将代价函数值最小的子节点作为下一节点next,并将节点next放入closed表中,若节点next为目标点,则找到路径,算法结束。若并非目标点,开始以节点next为父节点扩展周围子节点sub。
S5,计算节点next与节点sub之间的路径开销C(next,sub),当开销为无穷大时,表明节点next周围存在障碍,则将节点next从close表中剔除,并按照代价函数值从小到大顺序再从open表中选择下一个子节点作为下一节点next,并返回S4进行计算。
S6,当节点next与节点sub之间的路径开销C(next,sub)均不为无穷大时,判断节点sub是否在open表中,若在,则计算节点sub的代价函数值,并与节点next的代价函数值进行比较。当节点sub的代价函数值小于节点next的代价函数值,则直接跳到S7,反之则舍弃节点sub。若节点sub不在open表中,继续判断是否在close表中,如果不在,则将节点sub***open表中,然后执行S7。若节点sub在节点open表中,判断节点sub与节点next代价函数的大小关系,若节点sub代价函数值小于节点next的代价函数值,将节点sub从Close表移至Open表,并更新Close表代价值,反之舍弃节点sub。
S7,更新Open表中的代价值,并将指针指向Next。然后跳到S2。
3.根据权利要求2所述的一种双足机器人的路径规划方法,其特征在于,在子节点的实际代价值中加入角度评价从而减少不必要的转弯过程。若设父节点到当前节点的方向为向量A方向,当前节点到子节点的方向为向量B方向,角度偏移量的取值取决于向量A与向量B的夹角。
gnew(n)=Kgold(n)
K=-cos(∠AB)+2
其中,gold(n)为D*算法中的距离代价,gnew(n)为改进后的D*算法中的距离代价,K为角度偏移系数,用于根据角度的变化来改变距离代价的值,∠AB为向量A与向量B的夹角。
4.根据权利要求1中所述的一种双足机器人的路径规划方法,其特征在于,所述步骤四中,增加了双足机器人的关系映射,轨迹生成包括以下步骤:
S1建立倒立摆模型,同时将模型与机器人运动对应。假设机器人质心始终固定在机器人身上某处(实践中取两髋关节连线的中点),对应线性倒立摆中的质点M。倒立摆的支撑点同样对应机器人支撑脚上位置固定的一个点(一般取踝关节中心点在脚面上的垂直投影处)。
S2,确定每步之间落脚点信息的转换关系。
当机器人开始迈完一步,开始新一步时,存在如下转换关系:
当前一步支撑脚转换为下一步摆动脚起点,当前一步摆动脚终点(实际落脚点)转换为下一步支撑脚。
S3,步态规划,包括以下步骤
S31,实际落脚点求算
在实际步态规划中,机器人的目标落脚点位置P用步行参数(Sx Sy Sθ)描述,分别对应步长,步宽和步行方向,假设此时目标落脚点为Pn,下一时刻目标落脚点为Pn+1,两者满足以下关系:
S32质心轨迹求算
Pt (n+1)双足机器人落脚位置;
Tsup为双足机器人支撑脚切换时间;
得到双足支撑期质心始、末状态后,即可根据样条函数插值求双足支撑期质心轨迹。双足支撑期质心末状态,也就是接下来单足支撑期的质心始状态。运用轮式运动学模型,将整车线位移映射到双足机器人质心线位移上,但是在转换系数上除二,角速度以步行方向在单位时间ΔT的改变来实现。
S33踝关节轨迹规划
根据摆动脚起点以及求算得到的摆动脚终点(实际落脚点)即可以在x、y方向上规划机器人的摆动脚的运动,其运动由样条插值得到。
5.根据权利要求4中所述的一种双足机器人的路径规划方法,其特征在于,双足机器人的最大步长为Sxm=12。直立行走情况下,Sy可固定设置为两脚自然状态下的间距,为保证舵机性能和防止结构干涉,步行方向的改变幅度不能过大,限制为正负30度以内。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011491208.XA CN112650234B (zh) | 2020-12-16 | 2020-12-16 | 一种双足机器人的路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011491208.XA CN112650234B (zh) | 2020-12-16 | 2020-12-16 | 一种双足机器人的路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112650234A true CN112650234A (zh) | 2021-04-13 |
CN112650234B CN112650234B (zh) | 2022-05-17 |
Family
ID=75354563
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011491208.XA Active CN112650234B (zh) | 2020-12-16 | 2020-12-16 | 一种双足机器人的路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112650234B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113418522A (zh) * | 2021-08-25 | 2021-09-21 | 季华实验室 | Agv路径规划方法、跟随方法、装置、设备及存储介质 |
CN114415652A (zh) * | 2021-11-09 | 2022-04-29 | 南京南自信息技术有限公司 | 一种轮式机器人路径规划方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102736628A (zh) * | 2012-06-12 | 2012-10-17 | 华中科技大学 | 一种具有环境适应性的足式机器人稳定性控制方法及*** |
US20180004208A1 (en) * | 2015-12-02 | 2018-01-04 | Goertek Inc. | Method and device for controlling gait of biped robot |
CN108594815A (zh) * | 2018-04-20 | 2018-09-28 | 武汉大学 | 一种分阶段的轮式机器人移动路径规划方法 |
US20190118384A1 (en) * | 2016-04-29 | 2019-04-25 | Softbank Robotics Europe | A mobile robot with enhanced balanced motion and behavior capabilities |
CN109987169A (zh) * | 2017-12-29 | 2019-07-09 | 深圳市优必选科技有限公司 | 双足机器人的步态控制方法、装置、终端设备及介质 |
CN110315543A (zh) * | 2019-07-29 | 2019-10-11 | 北京理工大学 | 一种双足机器人步态生成与优化方法 |
CN111174798A (zh) * | 2020-01-17 | 2020-05-19 | 长安大学 | 一种足式机器人路径规划方法 |
CN111290389A (zh) * | 2020-02-25 | 2020-06-16 | 北京理工大学 | 一种双足机器人落脚位置控制***与方法 |
CN111674486A (zh) * | 2020-05-25 | 2020-09-18 | 浙江大学 | 双足机器人稳定步行控制方法、装置、设备及可读介质 |
-
2020
- 2020-12-16 CN CN202011491208.XA patent/CN112650234B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102736628A (zh) * | 2012-06-12 | 2012-10-17 | 华中科技大学 | 一种具有环境适应性的足式机器人稳定性控制方法及*** |
US20180004208A1 (en) * | 2015-12-02 | 2018-01-04 | Goertek Inc. | Method and device for controlling gait of biped robot |
US20190118384A1 (en) * | 2016-04-29 | 2019-04-25 | Softbank Robotics Europe | A mobile robot with enhanced balanced motion and behavior capabilities |
CN109987169A (zh) * | 2017-12-29 | 2019-07-09 | 深圳市优必选科技有限公司 | 双足机器人的步态控制方法、装置、终端设备及介质 |
CN108594815A (zh) * | 2018-04-20 | 2018-09-28 | 武汉大学 | 一种分阶段的轮式机器人移动路径规划方法 |
CN110315543A (zh) * | 2019-07-29 | 2019-10-11 | 北京理工大学 | 一种双足机器人步态生成与优化方法 |
CN111174798A (zh) * | 2020-01-17 | 2020-05-19 | 长安大学 | 一种足式机器人路径规划方法 |
CN111290389A (zh) * | 2020-02-25 | 2020-06-16 | 北京理工大学 | 一种双足机器人落脚位置控制***与方法 |
CN111674486A (zh) * | 2020-05-25 | 2020-09-18 | 浙江大学 | 双足机器人稳定步行控制方法、装置、设备及可读介质 |
Non-Patent Citations (7)
Title |
---|
ESLAMI MOSTAFA,等: "A novel three-mass inverted pendulum model for real-time trajectory generation of biped robots", 《2016 4TH INTERNATIONAL CONFERENCE ON ROBOTICS AND MECHATRONICS》 * |
周江琛,等: "基于变质心高度策略的双足机器人变步长步态规划", 《中南大学学报(自然科学版)》 * |
唐冲: "欠驱动双足机器人高效行走控制研究", 《中国优秀博硕士学位论文全文数据库(博士)信息科技辑》 * |
方夏章: "扫地机器人单目视觉障碍物探测及路径规划的设计与实现", 《中国优秀博硕士学位论文全文数据库(硕士)信息科技辑》 * |
樊朋涛,等: "基于遗传算法的双足足球机器人路径规划", 《现代计算机》 * |
蓝冬英: "自主仿人机器人路径规划研究", 《中国优秀博硕士学位论文全文数据库(硕士) 信息科技辑》 * |
袁海辉,等: "不确定性扰动下双足机器人动态步行的自适应鲁棒控制", 《浙江大学学报(工学版)》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113418522A (zh) * | 2021-08-25 | 2021-09-21 | 季华实验室 | Agv路径规划方法、跟随方法、装置、设备及存储介质 |
CN114415652A (zh) * | 2021-11-09 | 2022-04-29 | 南京南自信息技术有限公司 | 一种轮式机器人路径规划方法 |
CN114415652B (zh) * | 2021-11-09 | 2024-03-26 | 南京南自信息技术有限公司 | 一种轮式机器人路径规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112650234B (zh) | 2022-05-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5945419B2 (ja) | 脚式移動ロボットの脚体運動軌道生成装置。 | |
CN112650234B (zh) | 一种双足机器人的路径规划方法 | |
JP6606442B2 (ja) | 移動体の経路計画生成装置 | |
CN112378408A (zh) | 一种实现轮式移动机器人实时避障的路径规划方法 | |
CN111913490A (zh) | 基于落足调整的四足机器人动步态稳定控制方法及*** | |
CN108519773A (zh) | 一种结构化环境下无人驾驶车辆的路径规划方法 | |
CN108333931A (zh) | 一种面向崎岖地形的四足机器人双层结构步态规划方法 | |
CN108621161A (zh) | 基于多传感器信息融合的足式机器人本体状态估计方法 | |
CN108089578A (zh) | 一种用于双足步行机器人的步行运动规划方法 | |
CN111338384B (zh) | 一种仿蛇机器人自适应路径跟踪方法 | |
CN112486183B (zh) | 一种室内移动机器人的路径规划算法 | |
CN104407611A (zh) | 一种仿人机器人稳定行走的控制方法 | |
CN111596665B (zh) | 一种适用于腿足机器人规划的稠密高度地图构建方法 | |
CN112147889B (zh) | 一种四足机器人复合式越障轨迹规划方法 | |
CN111596654A (zh) | 基于改进d星路径规划算法的电缆沟机器人导航避障方法 | |
CN114964267B (zh) | 一种无人牵引车在多任务点环境下的路径规划方法 | |
CN112847371B (zh) | 一种仿人机器人动态跨越连续障碍物的运动规划方法 | |
CN111857142B (zh) | 一种基于强化学习的路径规划避障辅助方法 | |
CN112327869B (zh) | 基于关节速度规划的四足机器人对角步态运动控制方法 | |
Zhang et al. | A free gait generation method for quadruped robots over rough terrains containing forbidden areas | |
CN113641180B (zh) | 一种基于变质心的机器人越障控制方法和*** | |
Zhang et al. | A composite cog trajectory planning method for the quadruped robot walking on rough terrain | |
CN113830197A (zh) | 一种应用于双足机器人动态行走的平衡控制方法 | |
US8924013B2 (en) | Method and system for path planning and controlling | |
CN113467445A (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 |