1.一种农用装载车转向校正方法,其特征在于,包括如下步骤:
1)接收输入信号;
2)根据接收到的输入信号,滤除明显偏差过大的瞬时值;
3)滤除明显偏差过大的瞬时值后,计算死区宽度;
4)根据确定的死区宽度进行转向死区补偿,以对所述农用装载车转向进行校正。
2.如权利要求1所述的农用装载车转向校正方法,其特征在于:所述步骤3)中具体包括:S11)控制农用装载车向第一方向转向最大值,重复n次,测量并记录每次转向的具体转向角度,n为大于或等于2的自然数;
选取其中最大转向的值作为第一标准值,计算所述第一标准值与其他n-1次转向角度的第一差值,求取所述第一差值的平均值S1;
S12)通过第一计时模块,测量并记录在第一方向上每次转向到最大值的第一时间T1;
计算所述第一时间T1的平均时间T1av,所述第一标准值除以所述平均时间T1av,得到第一基准速度V1;
S13)控制农用转载车向第一方向转向小于最大值的任意一角度,重复m次,测量并记录每次转向的具体转向角度,m为大于或等于2的自然数;
计算m次具体转向角度的平均值,选取作为第二标准值,计算所述第二标准值与其他m-
1次转向角度的第二差值,以第二差值的绝对值计算第二差值的平均值S2;
S14) 通过第二计时模块,测量并记录在第一方向上每次转向到所述任意一角度的第二时间T2;计算所述第二时间T2的平均时间T2av,所述第二标准值除以所述平均时间T2av,得到二基准速度V2;
S15)计算第一死区宽度L1, 。
3.如权利要求2所述的农用装载车转向校正方法,其特征在于:所述步骤3)中具体包括:S21)控制农用装载车向第二方向转向最大值,重复n次,测量并记录每次转向的具体转向角度,n为大于或等于2的自然数;
选取其中最大转向的值作为第三标准值,计算所述第三标准值与其他n-1次转向角度的第三差值,求取所述第三差值的平均值S3;
S22)通过第三计时模块,测量并记录在第二方向上每次转向到最大值的第三时间T3;
计算所述第三时间T3的平均时间T3av,所述第三标准值除以所述平均时间T3av,得到第三基准速度V1;
S23)控制农用转载车向第二方向转向小于最大值的任意一角度,重复m次,测量并记录每次转向的具体转向角度,m为大于或等于2的自然数;
计算m次具体转向角度的平均值,选取作为第四标准值,计算所述第四标准值与其他m-
1次转向角度的第四差值,以第四差值的绝对值计算第四差值的平均值S4;
S24) 通过第四计时模块,测量并记录在第二方向上每次转向到所述任意一角度的第四时间T4;计算所述第四时间T4的平均时间T4av,所述第四标准值除以所述平均时间T4av,得到四基准速度V4;
S25)计算第二死区宽度L2, 。
4.如权利要求3所述的农用装载车转向校正方法,其特征在于:计算所述第一死区宽度L1和第二死区宽度L2的差值,当所述差值大于零时,判断所述差值是否大于第一预设差值阈值,如果大于所述第一预设差值阈值,将所述差值除以2得到第一死区偏差值,计算死区值,即将所述第一死区宽度L1减去所述第一死区偏差值,所述第二死区宽度L2加上所述第一死区偏差值,存储上述死区值;当所述差值等于零时,存储所述第一死区宽度L1和所述第二死区宽度L2的相同值;当所述差值小于零时,判断所述差值是否小于第二预设差值阈值,如果小于所述第二预设差值阈值,将所述差值除以2得到第二死区偏差值,计算死区值,即将所述第一死区宽度L1减去所述第二死区偏差值,所述第二死区宽度L2加上所述第二死区偏差值,存储上述死区值。
5.如权利要求4所述的农用装载车转向校正方法,其特征在于:将上述存储的死区值发送到控制器,所述控制器根据接收到的死区值进行转向死区补偿,并计算死区补偿时间。
6.如权利要求5所述的农用装载车转向校正方法,其特征在于:所述控制器通过最优控制算法控制死区补偿,在固有最优PD控制器确定参数调整的基础上,引入整数阶PD和分数阶PD两种控制结构,其控制模型为:其中,y为横向偏差,u为控制输入,即存储的死区值,Gc(s)为控制函数, 为延时函数。
7.如权利要求1所述的农用装载车转向校正方法,其特征在于:所述接收输入信号具体包括:接收用户进行转向校正命令,通过触摸显示屏接收用户的触摸信号或者通过远程用户终端接收所述转向校正命令。
8.如权利要求1所述的农用装载车转向校正方法,其特征在于:所述根据接收到的输入信号,滤除明显偏差过大的瞬时值具体包括:接收输入信号,进行多次转向控制,判断针对同一位置的转向是否存在明显超出正常值的转向,如果存在,则滤除该次转向数据,补充一次转向。
9.一种农用装载车转向校正系统,其特征在于,包括如权利要求1-8任意一项所述的农用装载车转向校正方法,具体包括:控制器,角度传感器,计时模块,驱动器,反馈检测器;所述角度传感器和计时模块将检测的角度和计算的时间传输给控制器,所述控制器计算转向死区,生产死区补偿控制信号,并发送给驱动器,驱动所述农用装载车转向校正,所述反馈检测器检测死区补偿的转向校正,反馈给所述控制器。
10.如权利要求9所述的农用装载车转向校正系统,其特征在于,所述控制器包括:位置计算模块、平均值计算模块、死区计算模块、输出控制模块;所述计时模块包括第一、第二、第三、第四计时模块;
所述位置计算模块控制农用装载车向第一方向转向最大值,重复n次,测量并记录每次转向的具体转向角度,n为大于或等于2的自然数;
选取其中最大转向的值作为第一标准值,计算所述第一标准值与其他n-1次转向角度的第一差值,所述平均值计算模块求取所述第一差值的平均值S1;
所述第一计时模块,测量并记录在第一方向上每次转向到最大值的第一时间T1;计算所述第一时间T1的平均时间T1av,所述第一标准值除以所述平均时间T1av,得到第一基准速度V1;
所述位置计算模块控制农用转载车向第一方向转向小于最大值的任意一角度,重复m次,测量并记录每次转向的具体转向角度,m为大于或等于2的自然数;
计算m次具体转向角度的平均值,选取作为第二标准值,计算所述第二标准值与其他m-
1次转向角度的第二差值,所述平均值计算模块以第二差值的绝对值计算第二差值的平均值S2;
所述第二计时模块,测量并记录在第一方向上每次转向到所述任意一角度的第二时间T2;计算所述第二时间T2的平均时间T2av,所述第二标准值除以所述平均时间T2av,得到二基准速度V2;
所述死区计算模块计算第一死区宽度L1, 。