预览加载中,请您耐心等待几秒...
1/9
2/9
3/9
4/9
5/9
6/9
7/9
8/9
9/9

在线预览结束,喜欢就下载吧,查找使用更方便

如果您无法下载资料,请参考说明:

1、部分资料下载需要金币,请确保您的账户上有足够的金币

2、已购买过的文档,再次下载不重复扣费

3、资料包下载后请先用软件解压,在使用对应软件打开

(19)国家知识产权局(12)发明专利申请(10)申请公布号CN114967697A(43)申请公布日2022.08.30(21)申请号202210608826.0(22)申请日2022.05.31(71)申请人上海影谱科技有限公司地址201721上海市青浦区金泽镇(西岑)水秀路318号108室(72)发明人陈超(74)专利代理机构北京知呱呱知识产权代理有限公司11577专利代理师丁彦峰(51)Int.Cl.G05D1/02(2020.01)权利要求书2页说明书5页附图1页(54)发明名称一种基于MPC控制的AGV路径跟踪方法及系统(57)摘要本发明公开了一种基于MPC控制的AGV路径跟踪方法及系统,基于MPC控制算法,对实时返回的位置偏差和角度偏差进行最优化控制,结合目标函数和约束条件进行最优求解得到当前时刻的AGV线速度和角速度,实现AGV路径跟踪。充分利用MPC算法结果鲁棒,适应场景广的优势,同时结合AGV实际需求忽略动力学进行计算简化,降低算力要求,实现AGV精准快速的路径跟踪。CN114967697ACN114967697A权利要求书1/2页1.一种基于MPC控制的AGV路径跟踪方法,其特征在于,所述方法包括:按照AGV线速度和角速度控制指令控制AGV运动,并实时返回AGV相对当前路径的位置偏差和角度偏差;基于MPC控制算法,对实时返回的位置偏差和角度偏差进行最优化控制,结合目标函数和约束条件进行最优求解得到当前时刻的AGV线速度和角速度,实现AGV路径跟踪。2.根据权利要求1所述的一种基于MPC控制的AGV路径跟踪方法,其特征在于,所述方法还包括:通过二维码定位和惯导传感器定位结合对AGV进行全地图精准定位获得AGV全局位姿,并根据AGV全局位姿计算出AGV相对当前路径的位置偏差和角度偏差。3.根据权利要求1所述的一种基于MPC控制的AGV路径跟踪方法,其特征在于,所述方法还包括:构建两轮差速AGV运动学模型离散化差分模型,具体为:记epsik为k时刻小车质心行进方向相对于路径中心线的偏差角度,ek为k时刻小车质心与路径中心线的横向偏差距离,wk为k时刻小车运动角速度,vk为k时刻小车运动线速度,θk为k时刻小车在地图坐标系的角度,xk为k时刻小车在地图坐标系的横坐标,yk为k时刻小车在地图坐标系的纵坐标,k时刻和k+1时刻状态转移满足以下运动学方程:xk+1=xk+vk·cos(θk)·dtyk+1=yk+vk·sin(θk)·dtθk+1=θk+wk·dtek+1=ek+vk·tan(epsik)·dtepsik+1=epsik+wk·dt。4.根据权利要求3所述的一种基于MPC控制的AGV路径跟踪方法,其特征在于,基于MPC控制算法,对实时返回的位置偏差和角度偏差进行最优化控制,结合目标函数和约束条件进行最优求解得到当前时刻的AGV线速度和角速度,具体包括:构建目标函数如下:we为ek的权重,wepsi为epsik的权重;动态模型约束为AGV运动学模型方程式,其中ek和epsik满足下式:ek=f(xk)‑ykepsik=arctan(f'(xk))‑θk;其中,f(xk)为目标轨迹拟合曲线;求解目标函数得到每个时刻所需控制量vk和wk。5.根据权利要求2所述的一种基于MPC控制的AGV路径跟踪方法,其特征在于,二维码定位具体包括:在地图特定位置铺设二维码,将实际位置坐标编码进二维码内容,相机实时拍摄包含二维码的图像,计算二维码在图像中的位置及角度,结合上述计算出相机在地图中的实际坐标及朝向,由于AGV与相机的相对位置固定即可得出AGV在地图中的实际坐标和朝向。6.根据权利要求2所述的一种基于MPC控制的AGV路径跟踪方法,其特征在于,惯导传感器定位具体包括:2CN114967697A权利要求书2/2页在AGV位姿初始值给定的前提下,基于惯导传感器采集的信息计算出每一时刻位姿相对于上一时刻位姿的距离以及方向角的变化,从而实现位姿的实时估计。7.一种基于MPC控制的AGV路径跟踪系统,其特征在于,所述系统包括:AGV控制器,用于按照AGV线速度和角速度控制指令控制AGV运动,并实时返回AGV相对当前路径的位置偏差和角度偏差;MPC控制器,用于基于MPC控制算法,对实时返回的位置偏差和角度偏差进行最优化控制,结合目标函数和约束条件进行最优求解得到当前时刻的AGV线速度和角速度,实现AGV路径跟踪。8.根据权利要求7所述的一种基于MPC控制的AGV路径跟踪系统,其特征在于,所述AGV控制器具体同于:通过二维码定位和惯导传感器定位结合对AGV进行全地图精准定位获得AGV全局位姿,并根据AGV全局位姿计算出AGV相对当前路径的位置偏差和角度偏差。3CN114967697A说明书1/5页一种基于MPC控制的AGV路径跟踪