[发明专利]一种AGV小车的平滑路径规划方法有效
| 申请号: | 202010980591.9 | 申请日: | 2020-09-17 |
| 公开(公告)号: | CN111880550B | 公开(公告)日: | 2023-10-10 |
| 发明(设计)人: | 彭天 | 申请(专利权)人: | 广东铁甲软件系统有限公司 |
| 主分类号: | G05D1/02 | 分类号: | G05D1/02 |
| 代理公司: | 东莞卓为知识产权代理事务所(普通合伙) 44429 | 代理人: | 汤冠萍 |
| 地址: | 528000 广东省佛山市南海区狮山镇*** | 国省代码: | 广东;44 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 一种 agv 小车 平滑 路径 规划 方法 | ||
1.一种AGV小车的平滑路径规划方法,其特征在于,包括如下步骤:
步骤一:对场地空间范围和已知障碍物的大小和位置进行测量,利用地图生成器的栅格法将场地空间范围进行单元化分隔,划分出的多个栅格,生成具有区域网状栅格的数字地图;
步骤2:在数字地图的基础上对划分出的多个栅格进行编号,得到编号栅格;
步骤3:对已知障碍物占据的编号栅格进行筛选删除;
步骤4:对保留下来的编号栅格采用分区法进行划分标点;
步骤5:根据实际需求规划AGV小车的设定起始点和目标站点位置;
步骤6:利用A*算法计算在剩下的编号栅格中选择安全位置集中的若干个编号栅格,并结合起始点和目标站点建立AGV小车的栅格编号行驶路线;
步骤7:利用所述栅格编号行驶路线上的若干个编号栅格的标点作为贝塞尔曲线的控制点,并结合起始点和目标站点,生成多条贝塞尔曲线路径;
步骤8:利用杜宾路径算法对相邻的控制点之间的贝塞尔曲线路径进行路径平滑;并实现路径转换避规;
步骤9:所述AGV小车设有测距激光扫描器进行周围环境信息的收集,所述AGV小车还设有路线选择模块,所述路线选择模块内设有tensorflow深度学习框架,测距激光扫描器判断是否有突发障碍物,如果没有,则AGV小车按照栅格编号行驶路线或多条贝塞尔曲线路径其中的一条路径正常移动;如果有突发障碍物,将栅格编号行驶路线通过路线选择模块转换成贝塞尔曲线路径,利用杜宾路径算法重新调整相邻的控制点之间的路径,从而构成连接路径,实现转换;并由AGV小车的位置以及AGV小车与突发障碍物之间的位置关系生成偏转指令,偏转指令转化为AGV小车的控制输入,实现避规动作。
2.根据权利要求1所述的AGV小车的平滑路径规划方法,其特征在于:所述步骤4中的编号栅格的分区标点方法为:
步骤4.1:所述编号栅格为每条相同长度的边构成的正方形框架,并设定好每条边的长度尺寸;
步骤4.2:在每条边的中间位置可以生成为一个标点一,四个标点一的坐标分别为(x1,y1)、(x2,y2)、(x3,y3)、(x4,y4);
步骤4.3:将平行的边上的中点相连接构成连线一及连线二,以及正方形的对角点相连接构成连线三及连线四,所述连接线一、连线二、连接线三及连接线四相交的点为中心点;
步骤4.4:所述中心点的坐标为((x1+x2+x3+x4)/4,(y1+y2+y3+y4)/4),每个编号栅格生成贝塞尔曲线所需要的控制点。
3.根据权利要求2所述的AGV小车的平滑路径规划方法,其特征在于:所述步骤5的具体方法为:沿起始点速度方向的顺时针和逆时针以AGV小车的最小转弯半径为半径做起始点速度方向的两个切圆N、N′;根据目标站点的坐标,找出与切圆N/N′相切且过目标站点的直线,从而找到两切圆上的切点;根据切点的坐标、目标站点的坐标、切圆的半径,利用余弦定理计算目标站点与切点之间的距离,选择与目标站点距离最短的切点H;按顺序连接起点、切点H、目标站点,从而构成一条由圆弧-直线组成的平滑路径,根据该路径在空间的导数生成目标站点的目标站点速度方向,将该目标站点速度方向作为下一个起始点的起始点速度方向。
4.根据权利要求3所述的AGV小车的平滑路径规划方法,其特征在于:所述步骤8中的AGV小车还设有中控系统及深度学习模块,所述深度学习模块的方法包括以下步骤:
步骤8.1:深度学习模块记录使用较少的贝塞尔曲线路径及栅格编号行驶路线;
步骤8.2:将记录的较少的贝塞尔曲线路径及栅格编号行驶路线反馈给中控系统,中控系统将记录的较少的贝塞尔曲线路径及栅格编号行驶路线划入禁行路径,保留使用较多的贝塞尔曲线路径及栅格编号行驶路线;
步骤8.3:AGV小车执行行驶使用较多的贝塞尔曲线路径及栅格编号行驶路线,直至到达目标站点。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于广东铁甲软件系统有限公司,未经广东铁甲软件系统有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010980591.9/1.html,转载请声明来源钻瓜专利网。





