四舵轮AGV的双阿克曼运动控制方法及系统与流程

摘要: 本发明涉及自动导引运输车运动控制,特别是一种四舵轮agv的双阿克曼运动控制方法及系统。背景技术:1、随着智能制造、柔性物流及大型装备自动化转运技术的发展,自动导...
四舵轮AGV的双阿克曼运动控制方法及系统与流程

本发明涉及自动导引运输车运动控制,特别是一种四舵轮agv的双阿克曼运动控制方法及系统。

背景技术:

1、随着智能制造、柔性物流及大型装备自动化转运技术的发展,自动导引运输车(automated guided vehicle,agv)逐渐由传统轻载、固定路线运输向大尺寸、重载、高机动性和高精度路径跟踪方向发展。对于采用四个独立驱动转向舵轮的agv底盘,阿克曼转向几何能够根据车辆轴距、轮距及期望运动状态协调各车轮的转向角和轮速,使各车轮的运动方向趋于满足绕同一瞬时转向中心运动的几何关系。现有重载agv通常采用两舵轮差速、四舵轮单阿克曼或全向轮等底盘形式,其中四舵轮单阿克曼方式具有控制结构相对简单、承载能力较强的特点,但在轴距、轮距较大的重载agv中容易受到转弯半径、轮胎横向滑动及路径跟踪误差的限制。大尺寸重载agv采用单阿克曼转向时存在转弯半径较大、受限空间适应性不足、后轮横向滑动以及运动学误差被放大等问题。因此,前后舵轮共同参与转向的双阿克曼控制逐渐成为提高四舵轮agv机动能力的一种技术路径。然而,理想双阿克曼模型通常建立在各舵轮转向角能够准确到达理论目标值、四个舵轮转向轴线能够严格交汇于同一瞬时转向中心的假设基础上。在实际运行过程中,受舵轮伺服响应滞后、机械安装偏差、重载条件下轮胎弹性变形、地面附着状态变化以及各转向执行机构动态特性差异影响,四个实际转向角对应的转向轴线可能无法严格交于同一点。若控制器仍仅依据期望路径曲率进行理想几何逆解并直接下发理论目标转向角和理论目标轮速,则难以定量反映当前四舵轮转向几何的一致程度,也难以区分整体瞬时转向中心偏移与各舵轮局部转向离散两类状态,从而可能产生轮间运动不协调、轮胎侧向拖曳及路径跟踪误差累积的问题。

2、cn110209162a本发明提供了一种有效提升agv运行稳定性和运行速度、减小转弯半径且提升载荷能力的基于阿克曼转向原理的四驱agv寻迹方法。本发明通过在agv底面上设置双相机实现agv前进方向上的色带的俯拍,获取色带的图像,对图像进行处理后,获得agv的当前的位置和位姿,通过驱动舵轮满足阿克曼原理算子,从而解决了四轮驱动的同步性问题和过载问题,同时也减小了圆弧寻轨应用下圆弧的轨迹半径,从而减少了对场地开阔性的依赖,进而实现了agv可靠稳定的寻色带轨道运动。本发明可应用于自动化设备领域。该技术主要根据视觉寻迹结果及阿克曼原理算子确定舵轮控制量,其控制过程侧重于根据车辆位置和位姿完成轨迹跟踪,未针对四个舵轮的实际转向角反向重构车辆当前的实际瞬时转向中心,也未根据各舵轮转向轴线相对于共同交汇位置的离散程度评价四轮转向几何一致性。因此,当多个舵轮因执行滞后或机械偏差而不能同时满足理论阿克曼几何关系时,难以进一步判断当前误差属于可通过调整瞬时转向中心补偿的整体性偏差,还是不宜继续采用当前理论运动指令的离散性异常。

3、cn110154787b一种双舵轮无人搬运车及其控制方法,该方法包括:获取无人搬运车的行进速度v和路径偏差;根据无人搬运车的行进速度v和路径偏差计算出前舵轮的行进速度v1、转向角度θ1和后舵轮的行进速度v2、转向角度θ2;根据前舵轮的行进速度v1、转向角度θ1和后舵轮的行进速度v2和转向角度θ2控制无人搬运车运动。将无人搬运车行进速度在以两舵轮中心连线为x轴,两舵轮中心连线的垂直方向为y轴的坐标系下进行分解,在坐标系中计算出两舵轮的行进速度和转向角度,只需知道无人搬运车行进速度v和路径偏差,无需关注无人搬运车行驶过程中的旋转半径,控制简单,便于操作,准确性好。该技术针对前、后两个舵轮建立速度和转向角计算关系,其控制对象及运动约束主要集中于双舵轮底盘,未涉及四个独立舵轮同时转向条件下多条瞬时转向中心约束线之间的一致性求解问题。同时,该技术根据行进速度和路径偏差直接计算舵轮控制量,缺少利用实际转向角构造当前车辆转向几何状态的反馈分析过程,因而不能根据实际瞬时转向中心与理论瞬时转向中心之间的空间偏移程度以及四条约束线的离散程度,对后续运动控制指令进行差异化处理。

技术实现思路

1、本部分的目的在于概述本发明的实施例的一些方面以及简要介绍一些较佳实施例,在本部分以及本技术的说明书摘要和发明名称中可能会做些简化或省略以避免使本部分、说明书摘要和发明名称的目的模糊,而这种简化或省略不能用于限制本发明的范围。

2、鉴于现有四舵轮agv阿克曼运动控制通常基于理想运动学模型直接计算各舵轮的目标转向角和目标轮速,在实际舵轮转向角受到伺服响应滞后、机械安装偏差、重载轮胎变形以及地面附着条件变化影响时,四个舵轮对应的转向轴线可能无法保持理论共点关系,进而存在理论瞬时转向中心与车辆实际转向状态不一致的问题,提出了本发明。

3、因此,本发明所要解决的问题在于如何根据四个舵轮的实际转向状态辨识agv当前的实际瞬时转向中心,并区分四舵轮转向几何关系的离散异常与实际瞬时转向中心相对于理论瞬时转向中心的整体偏移,进而针对不同转向状态对双阿克曼运动控制指令进行相应调整,以减小理论运动学解算结果与实际舵轮运动状态之间的不一致。

4、为解决上述技术问题,本发明提供如下技术方案:

5、第一方面,本发明实施例提供了一种四舵轮agv的双阿克曼运动控制方法,其包括,

6、获取agv的期望线速度、期望路径曲率以及四个舵轮的实际转向角,根据期望路径曲率确定当前控制周期的转弯状态,并确定与期望路径曲率对应的理论瞬时转向中心,得到四个舵轮的理论目标转向角和理论目标轮速;

7、根据四个舵轮的实际转向角和对应舵轮安装位置分别构建瞬时转向中心约束线,以各瞬时转向中心约束线到共同点距离平方和最小为条件,求解实际瞬时转向中心;计算各瞬时转向中心约束线到实际瞬时转向中心的距离平方和作为离散量,并计算实际瞬时转向中心相对于理论瞬时转向中心的偏移量;

8、根据离散量和偏移量执行分流决策,确定修正瞬时转向中心或采用备用指令;

9、根据修正瞬时转向中心重新计算四个舵轮的最终目标转向角和最终目标轮速,下发至各舵轮伺服控制器,并在下一控制周期重新获取四个舵轮的实际转向角。

10、第二方面,本发明实施例提供了一种四舵轮agv的双阿克曼运动控制系统,其包括:

11、理论解算模块,用于获取agv的期望线速度、期望路径曲率以及四个舵轮的实际转向角,根据期望路径曲率确定当前控制周期的转弯状态,并确定与期望路径曲率对应的理论瞬时转向中心,得到四个舵轮的理论目标转向角和理论目标轮速;

12、中心辨识模块,用于根据四个舵轮的实际转向角和对应舵轮安装位置分别构建瞬时转向中心约束线,以各瞬时转向中心约束线到共同点距离平方和最小为条件,求解实际瞬时转向中心;计算各瞬时转向中心约束线到实际瞬时转向中心的距离平方和作为离散量,并计算实际瞬时转向中心相对于理论瞬时转向中心的偏移量;

13、分流决策模块,用于根据离散量和偏移量执行分流决策,确定修正瞬时转向中心或采用备用指令;

14、协同控制模块,用于根据修正瞬时转向中心重新计算四个舵轮的最终目标转向角和最终目标轮速,下发至各舵轮伺服控制器,并在下一控制周期重新获取四个舵轮的实际转向角。

15、第三方面,本发明实施例提供了一种计算机设备,包括存储器和处理器,存储器存储有计算机程序,其中:处理器执行计算机程序时实现上述的四舵轮agv的双阿克曼运动控制方法的任一步骤。

16、第四方面,本发明实施例提供了一种计算机可读存储介质,其上存储有计算机程序,其中:计算机程序被处理器执行时实现上述的四舵轮agv的双阿克曼运动控制方法的任一步骤。

17、与现有技术相比,本发明有益效果为:

18、通过获取agv的期望线速度、期望路径曲率以及四个舵轮的实际转向角,并根据期望路径曲率确定理论瞬时转向中心、理论目标转向角和理论目标轮速,使期望运动状态首先转换为满足双阿克曼几何关系的基准控制量,为后续实际转向状态与理论转向状态的比较提供统一参照;

19、通过利用四个舵轮的实际转向角及对应舵轮安装位置构建瞬时转向中心约束线,并以各约束线到共同点的距离平方和最小为条件求解实际瞬时转向中心,可将四个舵轮受伺服滞后、机械偏差或轮胎变形影响后的实际转向状态统一映射至瞬时转向中心空间,其中离散量用于表征四个舵轮实际转向几何关系的一致程度,偏移量用于表征实际瞬时转向中心相对于理论瞬时转向中心的整体偏离程度,从而避免仅依据单个舵轮转角误差进行修正时难以区分局部失配与整体偏移的问题;

20、通过根据离散量和偏移量执行分流决策,并结合单周期修正上限、一致性缩减系数和可靠性系数对补偿量进行分层限制,同时对修正瞬时转向中心进行一次一致性验证及必要的二次微调,可在实际转向状态具有较好一致性时对理论瞬时转向中心进行受限修正,在离散程度较大或修正结果不满足一致性要求时转入备用指令,从而抑制因一次性过量补偿导致的转向指令突变,并提高修正结果与四舵轮实际几何状态的匹配程度;

21、通过在修正失败时结合连续修正失败次数采用上一控制周期指令或紧急停车策略,并在获得有效修正瞬时转向中心后重新计算四个舵轮的最终目标转向角和最终目标轮速并下发至各舵轮伺服控制器,再于下一控制周期重新采集实际转向角,使理论解算、实际状态辨识、修正决策、有效性验证和指令更新形成逐周期闭环控制链路,由此能够在保持双阿克曼转向机动性的同时降低四轮转向失配、轮胎侧向拖曳及路径跟踪误差累积的可能性,并提高四舵轮agv在重载及有限空间转向工况下的运动协调性、控制稳定性和异常状态下的运行安全性。