基于改进蚁群算法的变压器微型仿生鱼全局路径规划方法技术

本发明专利技术涉及一种基于改进蚁群算法的变压器微型仿生鱼全局路径规划方法，其技术特点在于：包括以下步骤：步骤1、建立变压器内部环境三维栅格地图，将变压器三维环境地图信息进行初始化；步骤2、计算变压器栅格模型中的微型仿生鱼所占栅格的势场合力和变压器微型仿生鱼的运动方向与势场合力的角度差；步骤3、计算变压器微型仿生鱼下一步栅格的概率选择移动方向；步骤4、判断该当前栅格是否落入陷阱，若没有则将该当前栅格加入禁忌表，否则将蚂蚁重新放入起始点重新开始；步骤5、判读变压器微型机器鱼移动的当前位置是否到达步骤1中所述的目标位置。本发明专利技术使变压器微型仿生鱼不再盲目进行搜索，提高了算法搜索速度和全局寻优能力。

Global path planning method of transformer micro bionic fish based on improved ant colony algorithm

【技术实现步骤摘要】
基于改进蚁群算法的变压器微型仿生鱼全局路径规划方法
本专利技术属于机器人运动轨迹规划
，涉及微型仿生鱼路径规划方法，尤其是一种基于改进蚁群算法的变压器微型仿生鱼全局路径规划方法。
技术介绍
变压器微型仿生鱼需要在大型变压器油中进行巡视，大型变压器体积巨大，仿生鱼在其内部游动的距离和时间较长，要求变压器仿生鱼在尽可能消耗较少能量的前提下游动至目标点，因此，如何在变压器中规划一条较短的无碰撞的路径，对微型仿生鱼的任务完成具有重要的意义。目前，国内外机器人运动轨迹规划策略多是基于二维空间，虽然部分二维规划策略可应用于三维空间，但对于三维空间的轨迹规划，存在占有存储空间大、计算复杂性等方面特有的难题，简单地将二维轨迹规划策略直接推广至三维空间并不可行。因此，如何制定一种存储空间小、计算简单的三维空间的运动轨迹规划方法是本领域技术人员亟欲解决的技术难题。
技术实现思路
本专利技术的目的在于克服现有技术的不足，提出一种设计合理、存储空间小、计算简单的基于改进蚁群算法的变压器微型仿生鱼全局路径规划方法。本专利技术解决其现实问题是采取以下技术方案实现的：一种基于改进蚁群算法的变压器微型仿生鱼全局路径规划方法，包括以下步骤：步骤1、建立变压器内部环境三维栅格地图，将变压器三维环境地图信息进行初始化，包括变压器微型仿生鱼运动的起始位置和目标位置、人工势场法的初始化和改进蚁群算法的初始化；步骤2、采用人工势场法计算变压器栅格模型中的微型仿生鱼所占栅格的势场合力，并计算变压器微型仿生鱼的运动方向与势场合力的角度差；步骤3、采用改进蚁群算法结合当前栅格处势场力的方向和仿生鱼邻近栅格相关的信息素，计算变压器微型仿生鱼下一步栅格的概率选择移动方向；步骤4、蚁群中的蚂蚁依据步骤3获得的概率选择移动方向移动至下一个栅格，并判断该当前栅格是否落入陷阱，若没有则将该当前栅格加入禁忌表，否则将蚂蚁重新放入起始点重新开始；步骤5、判读变压器微型机器鱼移动的当前位置是否到达步骤1中所述的目标位置，如没有到达指定目标点的位置，则跳转至步骤2直至找到目标点，结束。而且，所述步骤1获得的变压器内部环境三维栅格地图上，当变压器中的元件占用不满一个栅格时，可按照占用一个栅格来计算；所述人工势场法的初始化包括：引力系数、斥力系数；所述改进蚁群算法的初始化包括：蚁群中蚂蚁的数量、启发因子、期望启发因子、迭代次数、信息素挥发系数和禁忌表。而且，所述步骤2采用人工势场法计算变压器栅格模型中的微型仿生鱼所占栅格的势场合力Fto(Pf)为：其中，Fat(Pf)为目标点对微型仿生鱼所占栅格处产生的引力，Frej(Pf)为第j个障碍物栅格对微型仿生鱼所占栅格处产生的斥力，j＝1,2,3….m,表示障碍物所占栅格的序列；其中，引力Fat(Pf)、斥力Frej(Pf)为：其中，(xg,yg,zg)是目标点Pg的三维坐标，(x,y,z)是微型仿生鱼位置Pf的三维坐标；分别是三维坐标系X轴、Y轴、Z轴的单位矢量；(xoj,yoj,zoj)是障碍物位置Poj的三维坐标；(x,y,z)是微型仿生鱼位置Pf的三维坐标；ρ0为障碍物的最大影响距离。而且，所述步骤3中改进的蚁群算法为：依据步骤2中获得的人工势场合力Fto(Pf)，参照蚁群算法的状态转移概率公式，改进蚁群算法，蚂蚁按照以下的公式选择下一个节点：ηj＝5/(dg-dj)其中，表示单个蚂蚁从第i个栅格运动到相邻第j个栅格的概率；φij表示人工势场合力与栅格j方向的夹角；C表示栅格i周围的邻近栅格集合；ηj是改进的启发程度。本专利技术的优点和有益效果：本专利技术提供了一种基于改进蚁群算法的变压器微型仿生鱼全局路径规划方法，利用人工势场法为本专利技术的蚁群算法路径寻优提高了“方向性”，使变压器微型仿生鱼不再盲目进行搜索，提高了算法搜索速度和全局寻优能力。2、本专利技术将栅格法应用于变压器内部复杂环境的三维建模，可明显的减少存储的数据量、数据的更新和数据的搜索量；3、本专利技术采用人工势场法计算变压器栅格模型中的微型仿生鱼所占栅格的势场合力，并计算变压器微型仿生鱼的运动方向与势场合力的角度差，通过参照变压器微型仿生鱼栅格处势场力的方向可为本专利技术的蚁群算法路径寻优提高了“方向性”，使变压器微型仿生鱼不再盲目进行搜索4、本专利技术采用改进的蚁群算法的状态转移概率公式中除了引入人工势场合力Fto(Pf)方向外，还改进了启发程度ηj，ηj设为目标点与当前微型仿生鱼邻近栅格之间距离的倒数，此函数的作用是当微型仿生鱼靠近目标物时，增大目标物对微型仿生鱼的吸引力。进一步提高了蚁群算法路径寻优的“方向性”，进而提高了算法搜索速度和全局寻优能力。附图说明图1是本专利技术的一种基于改进蚁群算法的变压器微型仿生鱼全局路径规划方法的流程图；图2是本专利技术的变压器微型仿生鱼在变压器内部环境中的三维移动示意图。具体实施方式以下结合附图对本专利技术实施例作进一步详述：一种基于改进蚁群算法的变压器微型仿生鱼全局路径规划方法，如图1和图2所示，包括以下步骤：步骤1、建立变压器内部环境三维栅格地图，将变压器三维环境地图信息进行初始化，包括变压器微型仿生鱼运动的起始位置和目标位置、人工势场法的初始化和改进蚁群算法的初始化；所述步骤1获得的变压器内部环境三维栅格地图上，当变压器中的元件占用不满一个栅格时，可按照占用一个栅格来计算；所述人工势场法的初始化包括：引力系数、斥力系数；所述改进蚁群算法的初始化包括：蚁群中蚂蚁的数量、启发因子、期望启发因子、迭代次数、信息素挥发系数和禁忌表；在本实施例中，将该变压器进行60×30×10栅格建模，当变压器中的元件占用不满一个栅格时，可按照占用一个栅格来计算，栅格环境信息用0和1表示，0表示无障碍栅格，1表示有障碍栅格；设置蚂蚁数目为M，启发因子为α，期望启发因子为β，迭代次数为N，信息素挥发系数为ρ，禁忌表Bi(蚂蚁i当前走过的栅格点)为设置蚂蚁的起始点和终止点；设置人工势场法的引力系数Kat和斥力系数Kre。步骤2、采用人工势场法计算变压器栅格模型中的微型仿生鱼所占栅格的势场合力，并计算变压器微型仿生鱼的运动方向与势场合力的角度差；在本实施例中，所述步骤2采用人工势场法计算变压器栅格模型中的微型仿生鱼所占栅格的势场合力Fto(Pf)为：其中，Fat(Pf)为目标点对微型仿生鱼所占栅格处产生的引力，Frej(Pf)为第j个障碍物栅格对微型仿生鱼所占栅格处产生的斥力，j＝1,2,3….m,表示障碍物所占栅格的序列；其中，引力Fat(Pf)、斥力Frej(Pf)为：其中，(xg,yg,zg)是目标点Pg的三维坐标，(x,y,z)是微型仿生鱼位置Pf的三维坐标；分别是三维坐标系X轴、Y轴、Z轴的单位矢量；(xoj,yoj,zoj)是障碍物位置Poj的三维坐标；(x,y,z)是微型仿生鱼位置Pf的三维坐标；ρ0为障碍物的最大影响距离，是预先设定好的。步骤3、采用改进蚁群算法结合当前栅格处势场力的方向和仿生鱼邻近栅格相关的信息素，计算变压器微型仿生鱼下一步栅格的概率选择移动方向；所述步骤3中改进的蚁群算法为：依据步骤2中获得的人工势场合力Fto(Pf)，参照蚁群算法的状态转移概率公式，改进蚁群算法，蚂蚁按照以下的公式选择下一个节点：ηj＝5/(dg-dj)其中，表示单个蚂蚁本文档来自技高网...

【技术保护点】
1.一种基于改进蚁群算法的变压器微型仿生鱼全局路径规划方法，其特征在于：包括以下步骤：步骤1、建立变压器内部环境三维栅格地图，将变压器三维环境地图信息进行初始化，包括变压器微型仿生鱼运动的起始位置和目标位置、人工势场法的初始化和改进蚁群算法的初始化；步骤2、采用人工势场法计算变压器栅格模型中的微型仿生鱼所占栅格的势场合力，并计算变压器微型仿生鱼的运动方向与势场合力的角度差；步骤3、采用改进蚁群算法结合当前栅格处势场力的方向和仿生鱼邻近栅格相关的信息素，计算变压器微型仿生鱼下一步栅格的概率选择移动方向；步骤4、蚁群中的蚂蚁依据步骤3获得的概率选择移动方向移动至下一个栅格，并判断该当前栅格是否落入陷阱，若没有则将该当前栅格加入禁忌表，否则将蚂蚁重新放入起始点重新开始；步骤5、判读变压器微型机器鱼移动的当前位置是否到达步骤1中所述的目标位置，如没有到达指定目标点的位置，则跳转至步骤2直至找到目标点，结束。

【技术特征摘要】
1.一种基于改进蚁群算法的变压器微型仿生鱼全局路径规划方法，其特征在于：包括以下步骤：步骤1、建立变压器内部环境三维栅格地图，将变压器三维环境地图信息进行初始化，包括变压器微型仿生鱼运动的起始位置和目标位置、人工势场法的初始化和改进蚁群算法的初始化；步骤2、采用人工势场法计算变压器栅格模型中的微型仿生鱼所占栅格的势场合力，并计算变压器微型仿生鱼的运动方向与势场合力的角度差；步骤3、采用改进蚁群算法结合当前栅格处势场力的方向和仿生鱼邻近栅格相关的信息素，计算变压器微型仿生鱼下一步栅格的概率选择移动方向；步骤4、蚁群中的蚂蚁依据步骤3获得的概率选择移动方向移动至下一个栅格，并判断该当前栅格是否落入陷阱，若没有则将该当前栅格加入禁忌表，否则将蚂蚁重新放入起始点重新开始；步骤5、判读变压器微型机器鱼移动的当前位置是否到达步骤1中所述的目标位置，如没有到达指定目标点的位置，则跳转至步骤2直至找到目标点，结束。2.根据权利要求1所述的一种基于改进蚁群算法的变压器微型仿生鱼全局路径规划方法，其特征在于：所述步骤1获得的变压器内部环境三维栅格地图上，当变压器中的元件占用不满一个栅格时，可按照占用一个栅格来计算；所述人工势场法的初始化包括：引力系数、斥力系数；所述改进蚁群算法的初始化包括：蚁群中蚂蚁的数量、启发因子、期望启发因子、迭代次...

【专利技术属性】
技术研发人员：王伟，张弛，刘力卿，张鑫，李隆基，何金，冯军基，马昊，季洪鑫，
申请(专利权)人：国网天津市电力公司电力科学研究院，国网天津市电力公司，国家电网有限公司，清华大学，
类型：发明
国别省市：天津,12