自动导引运输车的控制方法、装置、设备及存储介质制造方法及图纸

本申请涉及自动导引运输车的控制领域，公开了自动导引运输车的控制方法、装置、设备及存储介质，本申请的方法包括通过磁导航传感器采集自动导引运输车的当前偏距值；当前偏距值用于指示当前自动导引运输车偏离导引路径中磁条中心线的距离与方向；磁导航传感器安装在自动导引运输车上；基于预设比例积分微分控制算法，对当前偏距值进行校正，得到校正后偏距值；预设比例积分微分控制算法用于控制自动导引运输车稳定运行；根据校正后偏距值，进行导航纠偏计算，得到导航纠偏结果；根据导航纠偏结果，控制自动导引运输车的行驶。可以提高磁导航的导航精度，使AGV在运行中的姿态更稳定。使AGV在运行中的姿态更稳定。使AGV在运行中的姿态更稳定。

【技术实现步骤摘要】
自动导引运输车的控制方法、装置、设备及存储介质


[0001]本申请涉及自动导引运输车的控制领域，具体涉及自动导引运输车的控制方法、装置、设备及存储介质。

技术介绍

[0002]随着工业自动化的发展，自动导引运输车(Automated Guided Vehicle，AGV)依靠以规定速度在导引路径上运动的优势在工业应用中脱颖而出。实际应用中多采用磁导航的方式控制AGV的行驶。大致工作流程为AGV控制系统通过AGV上的磁导航传感器感知地面磁条的磁场信号，然后根据磁场信号的强度和方向来确定AGV的位置和方向，进而控制AGV的行驶。但在实际应用中，会因为磁场信号的延迟、变化以及干扰等因素，会出现AGV姿态不稳以及偏离导引路径的情况，这就需要对AGV的行驶进行纠偏，以使AGV稳定运行。
[0003]对AGV的行驶进行纠偏的传统方法是AGV控制系统通过AGV上的磁导航传感器实时采集AGV的偏距值(偏距值为AGV的行驶路径偏离导引路径中磁条中心线的距离)，将该采集的偏距值用于后续的导航纠偏计算，进而依据导航纠偏计算的结果控制AGV的行驶以提高磁导航的精度。但传统方法中由于通信延迟以及AGV中电机响应延迟，会导致AGV控制系统对AGV的控制效果具有滞后性，从而会导致AGV在运行过程中产生晃动，导致AGV脱轨等问题降低磁导航的精度。
[0004]因此，如何提高AGV运行的稳定性以及磁导航的精度，已成为急需解决的问题。

技术实现思路

[0005]有鉴于此，本申请提供了一种自动导引运输车的控制方法、装置、设备及存储介质，以解决如何提高AGV运行的稳定性以及磁导航的精度的问题。
[0006]第一方面，本申请提供了一种自动导引运输车的控制方法，应用于自动导引运输车控制系统，该方法包括：
[0007]通过磁导航传感器采集自动导引运输车的当前偏距值；当前偏距值用于指示当前自动导引运输车偏离导引路径中磁条中心线的距离与方向；磁导航传感器安装在自动导引运输车上；
[0008]基于预设比例积分微分控制算法，对当前偏距值进行校正，得到校正后偏距值；预设比例积分微分控制算法用于控制自动导引运输车稳定运行；
[0009]基于校正后的偏距值通过运动控制算法，控制自动导引运输车的行驶。
[0010]在上述技术方案中，在通过自动导引运输车上的磁导航传感器采集自动导引运输车的当前偏距值后，通过可以控制自动导引运输车稳定运行的预设比例积分微分控制算法对当前偏距值进行校正，使得校正后偏距值具有稳定性，以抵消通信延迟以及AGV中电机响应延迟对通过磁导航传感器采集的当前偏距值的影响。进而基于校正后的偏距值通过运动控制算法，控制自动导引运输车的行驶时就可以抵消通信延迟以及AGV中电机响应延迟造成的不良影响，提高磁导航的精度从而使AGV的运行姿态更稳定。
[0011]在一种可选的实施方式中，预设比例积分微分控制算法包括比例参数、积分参数以及微分参数；基于预设比例积分微分控制算法，对当前偏距值进行校正，得到校正后偏距值，包括：
[0012]获取磁导航传感器采集的各个历次周期偏距值；
[0013]根据当前偏距值、比例参数、积分参数、微分参数以及历次周期偏距值，校正当前偏距值，得到校正后偏距值。
[0014]在上述技术方案中，通过利用各个历次周期偏距值以及可以用于控制AGV稳定运行的预设比例积分微分控制算法中的比例参数、积分参数以及微分参数对当前偏距值进行校正，考虑到AGV的偏距值在当前时刻之前的变化，进一步提高校正后偏距值的可靠性，进而后续基于该校正后偏距值对AGV的行驶进行纠偏时，可以进一步减少AGV运行过程中的晃动与超调，避免因为响应问题造成的脱轨与对接精度不够的问题，从而提高生产效率。
[0015]在一种可选的实施方式中，根据当前偏距值、比例参数、积分参数、微分参数以及历次周期偏距值，校正当前偏距值，得到校正后偏距值，包括：
[0016]根据比例参数，处理当前偏距值，得到放大后偏距值；
[0017]根据积分参数、历次周期偏距值以及当前偏距值，计算自动导引运输车的积分表现；
[0018]根据微分参数以及当前偏距值与上一时刻的历次周期偏距值之间的差值，计算自动导引运输车的微分表现；
[0019]根据预设参数，整合放大后偏距值、积分表现以及微分表现，以得到校正后偏距值。
[0020]在上述技术方案中，分别根据预设比例积分微分算法中的比例参数对当前偏距值进行处理，以对当前偏距值进行适当的缩放；基于积分参数、历次周期偏距值对当前偏距值进行处理，计算AGV的在一段时间内的积分表现以提高后续校正后偏距值的可靠性；基于微分参数以及当前偏距值与上一个历次周期偏距值的差值，计算AGV的微分表现，可以在后续的校正后偏距值的计算中，抵消基于积分参数计算的积分表现的不当变化，快速实现在导引路径中弯道恢复直线以及分叉口处路径选择。进而依据预设参数整合计算得到的校正后偏距值就具有使AGV稳定运行的特性。
[0021]在一种可选的实施方式中，在基于预设比例积分微分控制算法，对当前偏距值进行校正，得到校正后偏距值之前，方法还包括：
[0022]根据磁导航传感器的分辨率、预设分叉运行表现、预设直线运行表现以及预设弯道运行表现，确定比例参数、积分参数以及微分参数，以使预设比例积分微分控制算法控制自动导引运输车稳定运行；
[0023]预设分叉表现用于指示自动导引运输车在导引路径中的分叉路口处的期望运行表现。
[0024]在上述技术方案中，考虑自动导引运输车中磁导航传感器的分辨率以及期望的预设分叉运行表现、预设直线运行表现以及预设弯道运行表现，来确定预设比例积分微分控制算法中的比例参数、积分参数以及微分参数，可以使比例参数、积分参数以及微分参数符合预设的各个运行表现进而使预设比例积分微分控制算法控制自动导引运输车稳定运行。
[0025]在一种可选的实施方式中，根据磁导航传感器的分辨率、预设分叉运行表现、预设
直线运行表现以及预设弯道运行表现，确定比例参数、积分参数以及微分参数，包括：
[0026]根据磁导航传感器的分辨率以及预设系数，调整待更新比例参数；
[0027]根据自动导引运输车在导引路径中直线路径以及弯道路径的运行表现是否分别满足预设直线运行表现以及预设弯道运行表现，确定是否调整待更新积分参数以及待更新比例参数；
[0028]根据自动导引运输车在导引路径中分叉路口处的运行表现是否满足预设分叉运行表现，确定是否调整待更新微分参数；
[0029]将更新后的待更新比例参数、待更新积分参数以及待更新微分参数，分别确定为比例参数、积分参数以及微分参数。
[0030]在上述技术方案中，根据磁导航传感器的分辨率以及预设系数，调整待更新比例参数，进而依据自动导引运输车在导引路径中直线路径以及弯道路径的运行表现是否分别满足预设直线运行表现以及预设弯道运行表现，和导引路径中分叉路口处的运行表现是否满足预设分叉运行表现来确定比本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种自动导引运输车的控制方法，其特征在于，应用于自动导引运输车控制系统，所述方法包括：通过磁导航传感器采集自动导引运输车的当前偏距值；所述当前偏距值用于指示当前所述自动导引运输车偏离导引路径中磁条中心线的距离与方向；所述磁导航传感器安装在所述自动导引运输车上；基于预设比例积分微分控制算法，对所述当前偏距值进行校正，得到校正后偏距值；所述预设比例积分微分控制算法用于控制所述自动导引运输车稳定运行；基于校正后的偏距值通过运动控制算法，控制自动导引运输车的行驶。2.根据权利要求1所述的方法，其特征在于，所述预设比例积分微分控制算法包括比例参数、积分参数以及微分参数；所述基于预设比例积分微分控制算法，对所述当前偏距值进行校正，得到校正后偏距值，包括：获取所述磁导航传感器采集的各个历次周期偏距值；根据所述当前偏距值、比例参数、积分参数、微分参数以及所述历次周期偏距值，校正所述当前偏距值，得到所述校正后偏距值。3.根据权利要求2所述的方法，其特征在于，所述根据所述当前偏距值、比例参数、积分参数、微分参数以及所述历次周期偏距值，校正所述当前偏距值，得到所述校正后偏距值，包括：根据所述比例参数，处理所述当前偏距值，得到放大后偏距值；根据所述积分参数、历次周期偏距值以及当前偏距值，计算自动导引运输车的积分表现；根据所述微分参数以及当前偏距值与上一时刻的历次周期偏距值之间的差值，计算所述自动导引运输车的微分表现；根据预设参数，整合所述放大后偏距值、积分表现以及微分表现，以得到所述校正后偏距值。4.根据权利要求1至3任一项所述的方法，其特征在于，在基于预设比例积分微分控制算法，对所述当前偏距值进行校正，得到校正后偏距值之前，所述方法还包括：根据磁导航传感器的分辨率、预设分叉运行表现、预设直线运行表现以及预设弯道运行表现，确定比例参数、积分参数以及微分参数，以使所述预设比例积分微分控制算法控制自动导引运输车稳定运行；所述预设分叉表现用于指示所述自动导引运输车在导引路径中的分叉路口处的期望运行表现。5.根据权利要求4所述的方法，其特征在于，所述根据磁导航传感器的分辨率、预设分叉运行表现、预设直线运行表现以及预设弯道运行表现，确定比例参数、积分参数以及微分参数，包括：根据磁导航传感器的分辨率以及预...

【专利技术属性】
技术研发人员：李亮，李邵俊，任欢，
申请(专利权)人：华晓精密工业苏州有限公司，
类型：发明
国别省市：