一种带有运动学的复杂形状目标遗传路径规划方法
【专利摘要】本发明的目的在于提供一种带有运动学的复杂形状目标遗传路径规划方法，包括以下步骤：第一步，采用三维位姿法对路径进行编码；第二步，产生初始种群；第三步，对初始种群进行遗传操作；第四步，采用三段法对路径进行解码并设计适应度函数；第五步，将本次迭代评估后当前代种群路径进行遗传操作，产生下一代种群，将本次迭代第四步中修补后的基因加入到下一代种群中，如此反复进行下去直到所得路径的可行适应度函数的函数值不再发生变化，则迭代结束，收获最优路径解。本发明将机器人的不规则形状及运动学约束考虑均在内，引入基因修补策略和适应度函数惩罚策略，最优解收敛速度得到较大提升。
【专利说明】一种带有运动学的复杂形状目标遗传路径规划方法
【技术领域】
[0001]本发明涉及的是一种运动路径避碰方法。
【背景技术】
[0002]带有运动学约束的不规则形状目标路径规划具有重要的意义，能够在复杂环境下进行目标的路径规划，是保证机器人有效规避障碍，顺利到达目标点的重要条件。现有的路径规划方法仅能满足障碍简单环境下的目标路径规划，但当面对地图大、障碍多、障碍形状复杂的情况时，路径规划问题将变得复杂，在以往其它的路径规划方法中，均将规划目标简化为栅格点或圆形，并且计算可行路径时不考虑目标的转弯半径约束(即假设目标可以原地转弯)，直接以折线路径作为有效路径，而在有些情况下，会出现规划目标形状复杂且存在着转弯半径约束、障碍环境复杂等情况，这将导致传统的路径规划方法失效。
【发明内容】
[0003]本发明的目的在于提供能够在障碍复杂的环境下进行避碰规划的一种带有运动学的复杂形状目标遗传路径规划方法。
[0004]本发明的目的是这样实现的:
[0005]本发明一种带有运动学的复杂形状目标遗传路径规划方法，其特征是:
[0006](I)采用三维位姿法对路径进行编码:
[0007]路径编码采用二进制编码方式，给定目标起点位姿(xst，yst，Φ3?)及终点位姿(Xend, Yend, Φ end)，将地图分为NXM个栅格，每个栅格位置对应K个角度方向，这样每个路径中间点就是由(x，y，Φ)构成的三维矢量，且在NXMXK个离散空间点内随机分布，设定路径搜索空间范围为nXm的二维矩形区域，则地图中搜索精度为(n/N，m/M);将每个栅格对应的中间点设定为2 π的姿态范围，取姿态量化数量为K，每个姿态角度间隔为2 π /K，则整个编码空间变成三维离散位姿空间；
[0008](2)产生初始种群:
[0009]基于步骤(1)的编码方式，采用随机法产生初始种群:动态生成一个随机数，根据随机数生成一个基因，将其加入到初始种群中，再随机生成下一个基因，如此循环进行，直至生成的基因数量达到种群规模G为止，完成初始种群的产生；
[0010](3)对初始种群进行遗传操作:
[0011]将步骤(2)所生成的初始种群进行遗传操作，产生新一代种群；
[0012](4)采用三段法对路径进行解码并设计适应度函数:
[0013]采用三段法解码方式:针对给定的起点位姿矢量Usu yst, Φ3?)和终点位姿矢量(xend) Yend? Φ end)，通过起点圆弧一直线路径一终点圆弧连接起点、终点位姿两矢量，起点圆弧与起点矢量相切、终点圆弧与终点矢量相切，直线路径同时相切于起点圆弧和终点圆弧，起点圆弧和终点圆弧半径相同均为r，并大于目标的最小允许用转弯半径IV根据几何位置关系求出路径中间节点、中间姿态及路径长度；[0014]设计适应度函数对解码后的路径进行评价:
[0015]若解码后的路径无碰撞则认为解码后的路径是可行的，将解码后的路径总长度及与障碍最小距离作为路径评价指标，可行路径适应度函数W(p)为:
【权利要求】
1.一种带有运动学的复杂形状目标遗传路径规划方法，其特征是: (1)采用三维位姿法对路径进行编码: 路径编码采用二进制编码方式，给定目标起点位姿(Xst，yst，Φ3?)及终点位姿(Xend, Yend, Φ end)，将地图分为NXM个栅格，每个栅格位置对应K个角度方向，这样每个路径中间点就是由(x，y，Φ)构成的三维矢量，且在NXMXK个离散空间点内随机分布，设定路径搜索空间范围为nXm的二维矩形区域，则地图中搜索精度为(n/N，m/M);将每个栅格对应的中间点设定为2 π的姿态范围，取姿态量化数量为K，每个姿态角度间隔为2 π /K，则整个编码空间变成三维离散位姿空间； (2)产生初始种群: 基于步骤(1)的编码方式，采用随机法产生初始种群:动态生成一个随机数，根据随机数生成一个基因，将其加入到初始种群中，再随机生成下一个基因，如此循环进行，直至生成的基因数量达到种群规模G为止，完成初始种群的产生； (3)对初始种群进行遗传操作: 将步骤(2)所生成的初始种群进行遗传操作，产生新一代种群； (4)采用三段法对路径进行解码并设计适应度函数: 采用三段法解码方式:针对给定的起点位姿矢量(xst，yst，Φ3?)和终点位姿矢量(xend) Yend? Φ end)，通过起点圆弧一直线路径一终点圆弧连接起点、终点位姿两矢量，起点圆弧与起点矢量相切、终点圆弧与终点矢量相切，直线路径同时相切于起点圆弧和终点圆弧，起点圆弧和终点圆弧半径相同均为r，并大于目标的最小允许用转弯半径IV根据几何位置关系求出路径中间节点、中间姿态及路径长度； 设计适应度函数对解码后的路径进行评价: 若解码后的路径无碰撞则认为解码后的路径是可行的，将解码后的路径总长度及与障碍最小距离作为路径评价指标，可行路径适应度函数W (P)为:
2.根据权利要求1所述的一种带有运动学的复杂形状目标遗传路径规划方法，其特征是:步骤(1)中中间点个数为0(0<0 ≤ 3)。
3.根据权利要求1或2所述的一种带有运动学的复杂形状目标遗传路径规划方法，其特征是:所述的种群规模G的取值范围为0〈G ≤ 200。
【文档编号】G05D1/02GK104020772SQ201410270105
【公开日】2014年9月3日 申请日期:2014年6月17日 优先权日:2014年6月17日
【发明者】张智, 林圣琳, 王欣璐, 邱兵, 夏桂华, 朱齐丹 申请人:哈尔滨工程大学