[发明专利]一种集装箱装货用AGV导航定位方法有效
申请号: | 201911383254.5 | 申请日: | 2019-12-27 |
公开(公告)号: | CN111060105B | 公开(公告)日: | 2021-08-10 |
发明(设计)人: | 姜跃君;蔡亚 | 申请(专利权)人: | 安徽意欧斯物流机器人有限公司 |
主分类号: | G01C21/20 | 分类号: | G01C21/20;G05D1/02 |
代理公司: | 合肥律众知识产权代理有限公司 34147 | 代理人: | 赵娟 |
地址: | 230000 安徽省合肥市高新区*** | 国省代码: | 安徽;34 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 集装箱 装货 agv 导航 定位 方法 | ||
1.一种集装箱装货用AGV导航定位方法,其特征在于,该方法包括以下步骤:
在AGV(自动导引运输车)的正上方安装一个激光雷达,其中激光雷达的物理坐标系X轴与车体中心对称轴线重合;
自动导引运输车沿集装箱内中轴线行走,行走过程中由激光雷达采集集装箱内部点云数据;
从原始点云数据中自主提取集装箱两侧直线特征,从而计算激光雷达到集装箱左侧面和右侧面的距离,得到自动导引运输车偏离集装箱中轴线的距离偏差,通过两直线特征的斜率可以得到自动导引运输车航向角与集装箱中轴线的角度偏差;
根据距离偏差和角度偏差,使AGV的运动可以跟踪预定路线;
所述激光雷达的安装高度低于集装箱高度;
所述集装箱两侧直线特征分别是集装箱的左侧和右侧箱体特征;
所述集装箱两侧直线特征通过最小二乘法拟合得到两直线方程分别为:
AL*x+BL*y+CL=0
AR*x+BR*y+CR=0
其中,AL,BL,CL,AR,BR,CR分别是直线方程的系数,L为自动导引运输车识别到的集装箱左侧面直线特征,R为自动导引运输车识别到的集装箱右侧面直线特征;
计算自动导引运输车偏离集装箱中轴线的距离偏差方程为:
Dis tanc ebias=Dis tanc eL-Dis tanc eR;
计算自动导引运输车航向角与集装箱中轴线的角度偏差方程为:
2.根据权利要求1所述的一种集装箱装货用AGV导航定位方法,其特征在于,所述AGV车体的航向角与集装箱中轴线的角度偏差是左侧或右侧集装箱体在激光雷达坐标系中直线方程斜率的反正切值。
3.根据权利要求1所述的一种集装箱装货用AGV导航定位方法,其特征在于,所述AGV跟踪预定路线的方法是采用距离偏差和角度偏差计算AGV与集装箱的位姿偏差,再使用PID控制算法控制AGV车体运行方向及运行速度。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于安徽意欧斯物流机器人有限公司,未经安徽意欧斯物流机器人有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201911383254.5/1.html,转载请声明来源钻瓜专利网。