一种机器人路径规划方法及装置
专利汇可以提供一种机器人路径规划方法及装置专利检索，专利查询，专利分析的服务。并且本 发明 公开了一种基于改进觅食行为的人工鱼群 算法 的 机器人 路径规划方法，基于自由空间法的环境建模具有建模简单、易于实现的优点，由自由空间法建立自由链接线，连接自由链接线上的中点而构成机器人自由移动网络；通过Dijkstra算法搜索自由移动网络得到局部最 短路 径，再利用改进觅食行为的人工鱼群算法对搜索到的算法进一步优化，最终得到全局最短路径。该发明提供了搜索效率高的机器人路径规划方法及装置。，下面是一种机器人路径规划方法及装置专利的具体信息内容。
1.一种机器人路径规划方法，其特征在于，它包括如下步骤：
(1)机器人路径规划基于环境信息完全已知的全局路径规划；在机器人路径中把机器人简化成一个点，并在二维空间内运动，机器人通过双目视觉传感器和测距传感器感知自身当前的位姿和障碍物的位置；
(2)将双目视觉传感器和测距传感器采集的环境信息中的障碍物处理成凸多边形；
(3)构建基于自由空间法的机器人移动链接图模型；
设机器人的起始位置用start表示，终点位置用goal表示；用黑色多边形代替障碍物,以多边形顶点为端点的连线表示链接线，机器人自由移动路线由链接线中点的连线构成，连接各链接线中点组成机器人自由移动网络；
(4)通过Dijkstra算法求出机器人自由移动网络最短路径；
设链接线的中点i表示该链接线的路径点i，则取链接线上的路径点标识序列数作为路径编码，如果起始点或终点不在链接线上，则连接起始点或终点与最近链接线中点连线构成加入起始点或终点的新机器人自由移动网络；设路径点i与路径点j的权值为Wij,则对应权值的表达式为：
其中Vij代表路径点i、j在自由移动网络中的对应线段，如果在自由移动网络中不存在对应线段，则Vij＝∞；通过用Dijkstra算法搜寻起始点到终点的最优有效权值组合，获得最短机器人移动路径；
(5)建立机器人路径编码数学模型；
设路径编码Pi表示路径点i所在链接线上任意一点，其中，i＝1,2，...，n；则Pi的编码模型如下所示：
其中Pi1、Pi2表示链接线两端点，线段Pi1Pi2表示链接线；对其它路径点进行同样处理，得到对应路径点表达形式；路径编码Pi对应的路径编码序列为：P＝t1,t2,…,ti,…,tn，其中ti∈[0,1]，每一个编码系列只有对应一个机器人路径；通过搜索ti值，可以找到最优的路径编码；
(6)基于改进觅食行为的人工鱼群算法机器人路径优化模型；
(6.1)人工鱼模型：
利用路径编码方法生成m条人工鱼，人工鱼Xq表示为：
每条人工鱼有n个可变分量，且每个分量表示链接线上一点；
(6.2)适应值函数：
由于Pi＝Pi1+(Pi2-Pi1)ti，则Pi点坐标表示成：
因此描述路径长度的适应函数为：
其中，xi1表示第i条鱼在第一个点的x位置，yi1表示第i条鱼在第一个点的y位置，xi2表示第i条鱼在第二个点的x位置，yi2表示第i条鱼在第二个点的y位置；||PiPi-1||表示Pi和Pi-1两点的距离；
(6.3)定义人工鱼X1与人工鱼X2的距离：
设人工鱼X1为：X1＝(t11,t12,...,t1i)，人工鱼X2为：X2＝(t21,t22,...,t2i)，则人工鱼X1与X2的距离d由机器人的双目视觉传感器、测距传感器和位移传感器信息融合得到，表示为：
(6.4)人工鱼X1,X2,…,Xq,…,Xm的聚群的鱼群中心位置定义：
其中，i＝1,2，...，m；j＝i＝1,2，...，n；Center(X1,X2,...,Xq,...,Xm)表示取人工鱼X1,X2,…,Xq,…,Xm的鱼群中心位置，选取m条人工鱼的每个分量平均值；xq1表示第q条鱼的第1个元素，xq2表示第q条鱼的第2个元素，xqj表示第q条鱼的第j个元素，xqn表示第q条鱼的第n个元素；
(6.5)改进的觅食行为：
设Xinext表示人工鱼下一个状态，Xnext表示人工鱼经审视环节得到的最优状态，Xi表示人工鱼当前状态,visual表示感知距离，step表示移动最大步长；
定义审视环节：maxfind(Xi,visual,k)表示人工鱼Xi在通过双目视觉传感器和测距传感器感知距离visual范围内通过k次审视而获得k个状态，并从k个状态中找出最优状态；
则，改进的觅食行为即：
Xnext＝maxfind(Xi,visual,k)； 8)
设在人工鱼Xi通过双目视觉传感器和测距传感器感知距离visual范围内的人工鱼数量为m，则用X′inext表示执行聚群行为后的状态，用X"inext表示执行追尾行为后的状态；具体公式表示如下：
其中，Best(X1,X2,...,Xm)表示搜寻感知范围内的最优个体；
(7)通过运用改进觅食行为的人工鱼群算法对Dijkstra算法求得的最短机器人移动路径进一步的优化，获得全局最短路径；优化步骤如下所述：
(7.1)人工鱼的数量在10至100条之间，对每条人工鱼做随机初始赋值，每条人工鱼的每个变量取值范围是[0,1]；
(7.2)评估每条人工鱼三种行为的优劣，其中，三种行为包括觅食行为、聚群行为、追尾行为；选择三种行为中最优行为，再用执行这一行为后的状态与当前状态对比；如果优于当前状态则执行此行为，否则执行随机行为；
(7.3)检验终止条件，如果迭代次数达到规定次数，或收敛精度达到规定精度，则搜索终止。
2.一种用于实现如权利要求1中所述的机器人路径规划方法的装置，其特征在于，所述装置包括一个能执行人工鱼群算法的机器人、机器人视觉系统；其中机器人视觉系统由一个双目视觉传感器、一个位移传感器、一个测距传感器组成；
双目视觉传感器用于获取前方图像和利用图像中物体的形状变化情况估计机器人与障碍物的距离；
位移传感器用于测量机器人移动位移；
测距传感器用于测量机器人与障碍物的距离。
一种机器人路径规划方法及装置
技术领域
背景技术
发明内容
具体实施方式
| 标题 | 发布/更新时间 | 阅读量 |
|---|---|---|
| 一种机器人视觉测量系统及方法 | 2020-05-13 | 990 |
| 一种五子棋机器人视觉应用装置 | 2020-05-14 | 330 |
| 一种机器人视觉系统 | 2020-05-11 | 374 |
| 足球机器人视觉快速识别方法 | 2020-05-15 | 421 |
| 机器人视觉跟踪方法 | 2020-05-11 | 468 |
| 一种汽车用六轴机器人视觉抓取装置 | 2020-05-13 | 25 |
| 一种汽车用六轴机器人视觉抓取系统 | 2020-05-13 | 681 |
| 一种机器人视觉定位方法及系统 | 2020-05-14 | 848 |
| 工业机器人视觉检测系统 | 2020-05-12 | 330 |
| 机器人视觉系统 | 2020-05-12 | 864 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台，是提供专利分析，专利查询，专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据，免费查、免费专利分析。
专利汇分析报告产品可以对行业情报数据进行梳理分析，涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度，系统通过AI智能系统对图表进行解读，只需1分钟，一键生成行业专利分析报告。
