工业型激光导引AGV的双闭环控制系统及控制方法技术方案

本发明专利技术公开了一种工业型激光导引AGV的双位置闭环控制系统及控制方法，由检测模块和控制模块组成，其特征是检测模块是由作为电机位置传感器的编码器和作为AGV位姿传感器的激光扫描仪构成；控制模块由伺服驱动器和工控机构成，设置控制模块是由内位置环和外位置环构成的双位置闭环控制模块；内位置环为电机转角位置环，外位置环是以激光扫描仪读取AGV位姿信号，以外位置环中反馈的AGV位姿信号计算AGV当前位置的路径跟踪误差，将路径跟踪误差作为控制系统的输入量。本发明专利技术可以很好地实现工业型激光导引AGV的自主行走功能并保证AGV路径跟踪的快速性和平稳性。

【技术实现步骤摘要】

本专利技术属于机器人技术和自动化领域，特别涉及一种作业于自动化车间的自动导航运输车的工业型激光导引AGV的控制系统及其路径跟踪控制方法。
技术介绍
激光导引AGV(AGV，Automatic Guided Vehicle)是一种以激光作为导引方式的自动导航运输车，由于定位精度高，能适合多种环境的复杂路径，可快速变更行驶路径，目前得到广泛应用。控制系统是AGV的核心内容，而路径跟踪控制方法是保证AGV控制精度的关键所在。目前大部分激光导引AGV生产厂家的控制系统都是从瑞典的NDC公司引进的，其成套控制系统价格昂贵。已有公开的实验型AGV系统为单闭环控制系统，由于工业型AGV驱动装置中使用了减速器等传动系统，这些传动系统都存在由间隙引起的误差问题，又加上AGV是轮式移动机器人，车轮以及地面之间存在着非完整约束，故实验型AGV系统的单位置闭环控制系统在用于工业型激光导引AGV时势必存在有动态响应差等问题，产生很大的路径跟随误差。在路径跟踪控制方法方面，目前最常用的是模糊控制方法。模糊控制具有鲁棒性和稳定性好的特点，适用于复杂的非线性系统的控制，很多学者通过对AGV进行建模仿真或通过实验型本文档来自技高网...

【技术保护点】
１．一种工业型激光导引ＡＧＶ的双位置闭环控制系统，由检测模块和控制模块组成，其特征是：所述检测模块是由作为电机位置传感器的编码器和作为ＡＧＶ位姿传感器的激光扫描仪构成；所述控制模块由伺服驱动器和工控机构成，设置所述控制模块是由内位置环和外位置环构成的双位置闭环控制模块；所述内位置环为电机转角位置环，由编码器检测电机转角位置信号，将所述电机转角位置信号反馈到伺服驱动器，以伺服驱动器为电机驱动单元；所述外位置环是以激光扫描仪读取ＡＧＶ位姿信号，所述ＡＧＶ位姿信号反馈到工控机，工控机输出信号至伺服驱动器信号输入端，电机转动输出通过减速器驱动ＡＧＶ行走转向机构；以外位置环中反馈的ＡＧＶ位姿信号计算ＡＧ...

【技术特征摘要】
1.一种工业型激光导引AGV的双位置闭环控制系统，由检测模块和控制模块组成，其特征是：所述检测模块是由作为电机位置传感器的编码器和作为AGV位姿传感器的激光扫描仪构成；所述控制模块由伺服驱动器和工控机构成，设置所述控制模块是由内位置环和外位置环构成的双位置闭环控制模块；所述内位置环为电机转角位置环，由编码器检测电机转角位置信号，将所述电机转角位置信号反馈到伺服驱动器，以伺服驱动器为电机驱动单元；所述外位置环是以激光扫描仪读取AGV位姿信号，所述AGV位姿信号反馈到工控机，工控机输出信号至伺服驱动器信号输入端，电机转动输出通过减速器驱动AGV行走转向机构；以外位置环中反馈的AGV位姿信号计算AGV当前位置的路径跟踪误差，将所述路径跟踪误差作为控制系统的输入量。2.一种权利要求1所述工业型激光导引AGV控制系统的路径跟踪控制方法，其特征是采用模糊预测控制算法，在AGV运动所在平面的直角坐标系中，将AGV的位姿表示为(x，y，α)，其中(x，y)为AGV在所述直角坐标系中的位置坐标，α为所述AGV的方位角，所述方位角为AGV的中心轴线与x轴正向的夹角；设置所述AGV的目标位姿为(x′，y′，α′)，由激光扫描仪检测得到AGV的起点位姿为(x0，y0，α0)；根据相关路径规划算法规划出从所述起点位姿(x0，y0，α0)到目标位姿(x′，y′，α′)的理论路径L；定义实际位姿和目标位姿之间的误差为位姿误差，所述位姿误差包括法向位置误差epn和方位角误差eα；所述路径跟踪方法通过以下步骤完成：a、由激光扫描仪检测到AGV的实际位姿为(xA，yA，αA)，则AGV的方位角误差eα和法向位置误差epn分别为：eα＝αA-α′         (1)epn=k·|xAtanα′-x′tanα′+y′-yA|1+(tanα′)2---(2)]]>设定：当AGV实际位姿位于理论路径L的右侧时，k＝1；当AGV实际位姿位于理论路径L的左侧时，k＝-1；b、采用微分算法修正AGV的法向位置误差epn和方位角误差eα，获得修正法向位置误差epn0和修正方位角误差eα0分别为：epn0=epn+depn(t)Tddt---(3)]]>=epn+(epn(i)-epn(i-1))TdT]]>eα0=eα+deα(t)Tddt]]>(4)=epn+(eα(i)-eα(i-1))TdT]]>式中：Td为微分时间常数，T为采样周期，epn(i)为AGV当前采样点位姿的法向位置误差信号，eα(i)为AGV当前采样点位姿的方位角误差信号，epn(i-1)为AGV上一个采样点位姿的法向位置误差信号，eα(i-1)为AGV上一个采样点位姿的方位角误差信号，epn和eα的相邻时刻的采样点差值Δpn和Δα分别为：Δpn＝epn(i)-epn(i-1)；Δα＝eα(i)-eα(i-1)；c、通过模糊控制算法求得AGV实际控制量β首先将AGV的修正法向位置误差epn0和修正方位角误差eα0分别乘以法向位置误差...

【专利技术属性】
技术研发人员：吴焱明，赵韩，王秋杰，王军，尹晓红，
申请(专利权)人：合肥工业大学，
类型：发明
国别省市：34