CN114132838B - 一种无人天车运行过程中的防摇摆控制方法 - Google Patents

Abstract

本发明提供了一种无人天车运行过程中的防摇摆控制方法，涉及无人天车吊运钢材技术领域。本发明根据无人天车运行过程的吊具摇摆偏移量进行速度与加速度的自动调整，包括以下步骤：第一步，定义无人天车运行方向坐标系；第二步，设置防摇摆控制周期为T，即按照T间隔周期实施控制；第三步，根据大车、小车实时速度值计算当前加速度值；第四步，通过摆角检测仪实测角度信息，计算吊具相对于天车空间位置的相对偏移量；第五步，基于模糊控制方法，计算获得天车的大车与小车防摇摆加速度的调节增益系数；第六步，根据调节增益系数计算加速度调整量；第七步，通过计算获得的加速度调整量修正加速度。

Description

一种无人天车运行过程中的防摇摆控制方法

技术领域

本发明涉及无人天车吊运钢材的技术领域，尤其涉及针对无人行车运行过程防摇摆控制的技术领域。

背景技术

随着物联网、人工智能等信息技术的发展，钢铁企业正在向以智能工厂为载体、以关键制造环节智能化为核心、以端到端数据流为基础、以网通互联为支撑的智能制造模式转型。其中，起重机与库区的无人化与智能化建设，成为智能工厂建设极具代表性的一项技术。

无人天车在变速运动中吊具速度变化滞后于大车和小车速度变化，不可避免的会发生吊具晃动的情况，这给天车的安全运行带来了风险，为了消除这种速度变化的不同步，让天车在最短的时间内平稳的到达目标位置，无人天车控制系统设计中需要开发自动防摇摆控制技术。

防摇摆控制系统由摆动角度检测仪、红外标记和防摇摆控制模型组成。摆动角度检测仪安装在天车上部，红外标记安装在吊具上部，两两配合使用，可以测得吊具的晃动角度。根据实测的天车晃动角度、天车实际位置、速度信息，实时计算天车加速度调整量，并将该加速度调整量传递到传动变频器，即可控制天车大、小车速度，实现防摇摆控制。

现阶段的防摇摆控制模型，在由检测角度转化为加速度调整时，未充分考虑吊具相对天车的钢丝绳长度影响，并且未充分考虑偏移程度、天车运行速度方向、偏移方向等因素对调节增益的影响，容易导致参数设置合理所引起的调节效率低或者过调节问题。

发明内容

本发明是为了解决上述技术问题，提供一种模糊变增益防摇摆控制技术，充分考虑各种影响因素动态设置调节增益，充分保证了防摇摆控制的调节效率与控制稳定性。

本发明提供了一种无人天车运行过程中的防摇摆控制方法，根据无人天车运行过程的吊具摇摆偏移量进行速度与加速度的自动调整，包括以下步骤：

步骤1：定义无人天车运行方向坐标系，包括：

无人天车运行方向包括大车运动方向、小车运动方向、吊具运动方向以及吊具相对小车转动方向四个自由度，以无人天车HOME位为原点、大车前进方向为X轴正向、小车前进方向为Y轴正向建立平行于水平面的天车运行坐标系；

步骤2：设置防摇摆控制周期为T，即按照T间隔周期实施控制，包括：

实时测量获取无人天车T_n-1时刻的大车位置，小车位置，大车速度V_XTn-1，小车速度V_YTn-1，以及无人天车T_n时刻的大车位置，小车位置，大车速度V_XTn，小车速度V_YTn；

步骤3：根据大车速度从V_XTn-1到V_XTn的变化，根据公式(1)计算大车加速度a_XTn，包括：

a_XTn＝(V_XTn-V_XTn-1)/T (1)

根据小车速度从V_YTn-1到V_YTn的变化，根据公式(2)计算小车加速度a_YTn：

a_YTn＝(V_YTn-V_YTn-1)/T (2)

加速度计算完成的同时，也得到了加速度的方向；

步骤4：通过摆角检测仪实测角度信息，计算吊具相对于天车空间位置的相对偏移量，包括吊具X轴偏移程度X_Tn和吊具Y轴偏移程度Y_Tn；

步骤5：基于模糊控制方法，根据吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向确定，建立模糊控制模型获得大车加速度调节增益系数P_XTn；根据吊具Y轴偏离程度、小车加速度方向、吊具Y轴偏离方向确定，建立模糊控制模型获得小车加速度调节增益系数P_YTn；

步骤6：将吊具X轴偏移程度X_Tn乘以大车加速度调节增益系数P_XTn，根据公式(3)得到大车加速度调整量Δa_XTn：

Δa_XTn＝X_Tn*P_XTn (3)

将吊具Y轴偏移程度Y_Tn乘以小车加速度调节增益系数P_YTn，根据公式(4)得到小车加速度调整量Δa_YTn：

Δa_YTn＝Y_Tn*P_YTn (4)

步骤7：通过大车、小车加速度调整量Δa_XTn与Δa_YTn修正T_n+1时刻的加速度，根据公式(5)以及公式(6)得到：

a_XTn+1＝a_XTn+Δa_XTn (5)

a_YTn+1＝a_YTn+Δa_YTn (6)

至此，完成了根据摇摆偏移量的天车加速度调整控制。

优选地，步骤4中，通过摆角检测仪实测角度信息，计算吊具X轴偏移程度X_Tn和吊具Y轴偏移程度Y_Tn，包括：

将小车水平面按XY轴分为Ⅰ、Ⅱ、Ⅲ、Ⅳ四个象限，主钩钢丝绳长度为L，L在XZ平面投影为L_xz，L_xz在XZ平面与Z轴的夹角为α₁，L在YZ平面上投影为L_yz，L_yz在YZ平面与Z轴的夹角为α₂，夹角α₁与α₂即为摆角检测仪实测角度；

根据公式(7)以及公式(8)，计算T_n时刻吊具X轴偏移程度X_Tn和吊具Y轴偏移程度Y_Tn：

X_Tn＝L_xz·sinα₁ (7)

Y_Tn＝L_yz·sinα₂ (8)

根据公式(9)以及公式(10)，由空间中存在的几何关系得到：

联立所述公式(9)以及公式(10)解得吊具X轴偏移程度X_Tn和吊具Y轴偏移程度Y_Tn分别与夹角α₁、α₂之间的关系式：

由此，根据摆角检测仪实测角度α₁、α₂计算出吊具X轴偏移程度X_Tn、吊具Y轴偏移程度Y_Tn。

优选地，步骤5中，基于模糊控制方法，获得大车加速度调节增益系数P_XTn，包括：

步骤5.1：确定输入、输出变量的模糊子集，包括：

包括吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向和大车加速度调节增益系数，模糊子集取值设定如下：

吊具X轴偏离程度X_Tn在模糊运算中记为S，设定其模糊子集m_S为：{大，中，小}；

大车加速度方向在模糊运算中记为D，设定其模糊子集m_D为：{正，负}；

吊具X轴偏离方向在模糊运算中记为W，设定其模糊子集m_W为：{正，负}；

大车加速度调节增益系数P_XTn在模糊运算中记为Q，设定其模糊子集m_Q为：{大大，中大，小大，大小，中小，小小}；

步骤5.2：变量模糊化，包括：

吊具X轴偏离程度S的基本物理论域为设定的最小值到最大值取值区间[Sv_min，Sv_max]，大车加速度方向D的基本物理论域为{-1，1}，吊具X轴偏离方向W的基本物理论域为{-1，1}，大车加速度调节增益系数Q的基本物理论域为[Qv_min，Qv_max]；

将基本物理论域转化为以离散自然数方式描述的模糊值域，实现变量模糊化；吊具X轴偏离程度S的模糊值域为{1,…,E_S}，吊具X轴偏离程度S的模糊值e_S的转化公式如下：

吊具X轴偏离程度S即为步骤4计算出的吊具X轴偏移程度X_Tn，模糊集最大值E_S取为3，即吊具偏离程度S的模糊值e_S∈{1,2,3}；

大车加速度方向D的模糊值域为{-1,1}，大车加速度方向D的模糊值e_D等于大车加速度方向取值：

e_D＝D (14)

即大车加速度方向D的模糊值e_D∈{-1,1}；

吊具X轴偏离方向W的模糊值域为{-1,1}，吊具X轴偏离方向W的模糊值e_W等于吊具X轴偏离方向取值：

e_W＝W (15)

即吊具X轴偏离程度W的模糊值e_W∈{-1,1}；

大车加速度调节增益系数Q的模糊值域为{0,1,…,E_Q}，大车加速度调节增益系数Q的模糊值e_Q的转化公式如下：

模糊集最大值E_Q取为6，即大车加速度调节增益系数Q的模糊值e_Q∈{0,1,2,3,4,5,6}；

步骤5.3：设定模糊值域对模糊子集的隶属度，包括：

针对各变量设定模糊值域对模糊子集的隶属度，吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度分别定义为μ_S、μ_D、μ_W、μ_Q；分别确定吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度；

步骤5.4：建立大车加速度调节增益系数的模糊控制规则表；

步骤5.5：建立模糊关系矩阵，包括：

所述模糊控制规则表包括12条规则，形成模糊关系矩阵R，其为每一条规则对应子矩阵R_i的合成；子矩阵R_i为对应子规则i中吊具X轴偏离程度的隶属度矩阵μ_Si、大车加速度方向的隶属度矩阵μ_Di、吊具X轴偏离方向的隶属度矩阵μ_Wi、大车加速度调节增益系数的隶属度矩阵μ_Qi四者之间的直积运算：

R_i＝μ_Si×μ_Di×μ_Wi×μ_Qi，i＝1,2,…,12 (17)

对子矩阵R_i进行合并运算，得到模糊关系矩阵R，

即模糊关系矩阵R中任意位置元素，为所有12个子矩阵R_i中相同位置元素的最大值；

基于所述吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度值，计算得到模糊关系矩阵R

步骤5.6：通过模糊关系矩阵R求解大车加速度调节增益系数Q，包括：

通过吊具X轴偏离程度，大车加速度方向，吊具X轴偏离方向，参照式(13)～式(16)，分别转化模糊值e_S、e_D、e_W，并分别按照所述吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向的隶属度值，转化为隶属度矩阵μ_S ^*、μ_D ^*、μ_W ^*；

在此基础上，计算出大车加速度调节增益系数的隶属度矩阵μ_Q，如公式(20)所示：

μ_Q为一个1*7的行向量，在该行向量中的7个元素中比较获取到数值最大的元素所在列数L_Q，利用以下列数L_Q与模糊值e_Q的对应关系，求解e_Q；

e_Q＝L_Q-1 (21)

最后，将模糊值e_Q通过公式(16)计算得到大车加速度调节增益系数Q，即大车加速度调节增益系数P_XTn；

通过公式(22)利用模糊值e_Q计算得到大车加速度调节增益Q，即P_XTn：

优选地，步骤5中，采用与大车加速度调节增益系数P_XTn相同的方式获得小车加速度调节增益系数P_YTn。

附图说明

为了更清楚地说明本发明实施例中的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。

图1为本发明实施例的一种无人天车运行过程中的防摇摆控制方法的方法流程图；

图2为本发明实施例的一种无人天车运行过程中的防摇摆控制方法的无人天车运动过程坐标系示意图。

图3为本发明实施例的一种无人天车运行过程中的防摇摆控制方法的摆动角度图形解析。

图4为本发明实施例的一种无人天车运行过程中的防摇摆控制方法的天车防摇摆加速度模糊控制器。

具体实施方式

为使本发明要解决的技术问题、技术方案和优点更加清楚，下面将结合附图及具体实施例进行详细描述。

如图1所示，本发明实施例提供一种无人天车运行过程中的防摇摆控制方法，即根据无人天车运行过程的吊具摇摆偏移量进行速度与加速度的自动调整，包括以下步骤：

步骤1：定义无人天车运行方向坐标系；

无人天车运行方向包括大车运动方向、小车运动方向、吊具运动方向以及吊具相对小车转动方向四个自由度，以无人天车HOME位为原点、大车前进方向为X轴正向、小车前进方向为Y轴正向建立平行于水平面的天车运行坐标系；如图2所示，为本发明实施例的无人天车运动过程坐标系示意图。

步骤2：设置防摇摆控制周期为T，即按照T间隔周期实施控制；

实时测量获取无人天车T_n-1时刻的大车位置，小车位置，大车速度V_XTn-1，小车速度V_YTn-1，以及无人天车T_n时刻的大车位置，小车位置，大车速度V_XTn，小车速度V_YTn；

步骤3：根据大车速度从V_XTn-1到V_XTn的变化，计算大车加速度a_XTn：

a_XTn＝(V_XTn-V_XTn-1)/T (1)

根据小车速度从V_YTn-1到V_YTn的变化，计算小车加速度a_YTn：

a_YTn＝(V_YTn-V_YTn-1)/T (2)

加速度计算完成的同时，也得到了加速度的方向；

步骤4：通过摆角检测仪实测角度信息，计算吊具相对于天车空间位置的相对偏移量，包括吊具X轴偏移程度X_Tn和吊具Y轴偏移程度Y_Tn；

步骤5：基于模糊控制方法，根据吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向确定，建立模糊控制模型获得大车加速度调节增益系数P_XTn；根据吊具Y轴偏离程度、小车加速度方向、吊具Y轴偏离方向确定，建立模糊控制模型获得小车加速度调节增益系数P_YTn；

步骤6：将吊具X轴偏移程度X_Tn乘以大车加速度调节增益系数P_XTn，得到大车加速度调整量Δa_XTn：

Δa_XTn＝X_Tn*P_XTn (3)

将吊具Y轴偏移程度Y_Tn乘以小车加速度调节增益系数P_YTn，得到小车加速度调整量Δa_YTn：

Δa_YTn＝Y_Tn*P_YTn (4)

步骤7：通过大车、小车加速度调整量Δa_XTn与Δa_YTn修正T_n+1时刻的加速度：

a_XTn+1＝a_XTn+Δa_XTn (5)

a_YTn+1＝a_YTn+Δa_YTn (6)

至此，完成了根据摇摆偏移量的天车加速度调整控制。

优选地，如图3所示，为本发明实施例的摆动角度图形解析。步骤4中，通过摆角检测仪实测角度信息，计算吊具X轴偏移程度X_Tn和吊具Y轴偏移程度Y_Tn，包括：

将小车水平面按XY轴分为Ⅰ、Ⅱ、Ⅲ、Ⅳ四个象限，主钩钢丝绳长度为L，L在XZ平面投影为L_xz，L_xz在XZ平面与Z轴的夹角为α₁，L在YZ平面上投影为L_yz，L_yz在YZ平面与Z轴的夹角为α₂，夹角α₁与α₂即为摆角检测仪实测角度；

首先计算T_n时刻吊具X轴偏移程度X_Tn和吊具Y轴偏移程度Y_Tn：

X_Tn＝L_xz·sinα₁ (7)

Y_Tn＝L_yz·sinα₂ (8)

由空间中存在的几何关系：

联立解得吊具X轴偏移程度X_Tn和吊具Y轴偏移程度Y_Tn分别与夹角α₁、α₂之间的关系式：

由此，根据摆角检测仪实测角度α₁、α₂计算出吊具X轴偏移程度X_Tn、吊具Y轴偏移程度Y_Tn。

优选地，如图4所示，为本发明实施例的天车防摇摆加速度模糊控制器。步骤5中，基于模糊控制方法，获得大车加速度调节增益系数P_XTn，包括：

步骤5.1：确定输入、输出变量的模糊子集

包括吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向和大车加速度调节增益系数，模糊子集取值设定如下：

吊具X轴偏离程度X_Tn在模糊运算中记为S，设定其模糊子集m_S为：{大，中，小}；

大车加速度方向在模糊运算中记为D，设定其模糊子集m_D为：{正，负}；

吊具X轴偏离方向在模糊运算中记为W，设定其模糊子集m_W为：{正，负}；

大车加速度调节增益系数P_XTn在模糊运算中记为Q，设定其模糊子集m_Q为：{大大，中大，小大，大小，中小，小小}；

步骤5.2：变量模糊化

吊具X轴偏离程度S的基本物理论域为设定的最小值到最大值取值区间[Sv_min，Sv_max]，大车加速度方向D的基本物理论域为{-1，1}，吊具X轴偏离方向W的基本物理论域为{-1，1}，大车加速度调节增益系数Q的基本物理论域为[Qv_min，Qv_max]；

将基本物理论域转化为以离散自然数方式描述的模糊值域，实现变量模糊化；吊具X轴偏离程度S的模糊值域为{1,…,E_S}，吊具X轴偏离程度S的模糊值e_S的转化公式如下：

吊具X轴偏离程度S即为步骤4计算出的吊具X轴偏移程度X_Tn，模糊集最大值E_S取为3，即吊具偏离程度S的模糊值e_S∈{1,2,3}；

大车加速度方向D的模糊值域为{-1,1}，大车加速度方向D的模糊值e_D等于大车加速度方向取值：

e_D＝D (14)

即大车加速度方向D的模糊值e_D∈{-1,1}；

吊具X轴偏离方向W的模糊值域为{-1,1}，吊具X轴偏离方向W的模糊值e_W等于吊具X轴偏离方向取值：

e_W＝W (15)

即吊具X轴偏离程度W的模糊值e_W∈{-1,1}；

大车加速度调节增益系数Q的模糊值域为{0,1,…,E_Q}，大车加速度调节增益系数Q的模糊值e_Q的转化公式如下：

模糊集最大值E_Q取为6，即大车加速度调节增益系数Q的模糊值e_Q∈{0,1,2,3,4,5,6}；

步骤5.3：设定模糊值域对模糊子集的隶属度

针对各变量设定模糊值域对模糊子集的隶属度，吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度分别定义为μ_S、μ_D、μ_W、μ_Q，如表1～表4所示，表1～表4中的行表头分别代表吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的模糊值，表1～表4中的列表头分别代表吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的模糊子集取值，表1～表4中的元素分别为吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度；

表1 吊具X轴偏离程度模糊隶属度μ_S表

表2 大车加速度方向模糊隶属度μ_D表

表3 吊具X轴偏离方向模糊隶属度μ_W表

表4 大车加速度调节增益系数模糊隶属度μ_Q表

步骤5.4：建立大车加速度调节增益系数的模糊控制规则表，如表5所示；

表5 大车加速度调节增益系数的模糊控制规则表

步骤5.5：建立模糊关系矩阵

上述模糊控制规则表共12条规则，形成模糊关系矩阵R，其为每一条规则对应子矩阵R_i的合成；子矩阵R_i为对应子规则i中吊具X轴偏离程度的隶属度矩阵μ_Si、大车加速度方向的隶属度矩阵μ_Di、吊具X轴偏离方向的隶属度矩阵μ_Wi、大车加速度调节增益系数的隶属度矩阵μ_Qi四者之间的直积运算：

R_i＝μ_Si×μ_Di×μ_Wi×μ_Qi，i＝1,2,…,12 (17)

对子矩阵R_i进行合并运算，得到模糊关系矩阵R，

即模糊关系矩阵R中任意位置元素，为所有12个子矩阵R_i中相同位置元素的最大值；

基于表1～表4设定的隶属度值，计算得到12×7维的模糊关系矩阵R如下：

步骤5.6：通过模糊关系矩阵R求解大车加速度调节增益系数Q

通过吊具X轴偏离程度，大车加速度方向，吊具X轴偏离方向，参照式(13)～式(16)，分别转化模糊值e_S、e_D、e_W，并分别按照表1～表3，转化为隶属度矩阵μ_S ^*、μ_D ^*、μ_W ^*；

在此基础上，计算出大车加速度调节增益系数的隶属度矩阵μ_Q，如下式所示：

μ_Q为一个1*7的行向量，在该行向量中的7个元素中比较获取到数值最大的元素所在列数L_Q，利用以下列数L_Q与模糊值e_Q的对应关系，求解e_Q；

e_Q＝L_Q-1 (21)

最后，将模糊值e_Q通过式(16)计算得到大车加速度调节增益系数Q，即大车加速度调节增益系数P_XTn。

最后通过式(22)利用模糊值e_Q计算得到大车加速度调节增益Q，即P_XTn：

优选地，步骤5中，采用与大车加速度调节增益系数P_XTn相同的方式获得小车加速度调节增益系数P_YTn。

对大车加速度调节增益系数P_XTn计算示例如下，不妨取S取值范围为[0，100]，单位为cm，实际检测偏离程度S＝50cm；天车加速度方向为负，记为D＝-1；吊具偏离方向为正，记为W＝1；加速度增益Q取值范围为[0,10]，单位m/s²。

根据式(13)，实际检测偏离程度S模糊化后得取值为：

据表1，当e_S＝2时，其最大隶属度对应模糊子集为“中”，其隶属度矩阵为：

μ_S ^*＝[0.2 1 0.3]

同理，若D＝-1，W＝1，根据式(14)～式(15)，可得其模糊化后取值分别为：

e_D＝-1，e_w＝1

其隶属度矩阵分别为：

μ_D ^*＝[1 0]

μ_W ^*＝[0 1]

据式(20)计算得到μ_Q：

在该计算结果中选择最大隶属度所在列，当隶属度为0.6时，其所在列为5，即：

L_Q＝5

故：e_Q＝L_Q-1＝4

最后通过式(22)利用模糊值e_Q计算得到加速度调节增益Q：

即大车加速度调节增益系数P_XTn＝8.3。

本领域普通技术人员可以理解实现上述实施例的全部或部分步骤可以通过硬件来完成，也可以通过程序来指令相关的硬件完成，所述的程序可以存储于一种计算机可读存储介质中，上述提到的存储介质可以是只读存储器，磁盘或光盘等。

以上所述仅为本发明的较佳实施例，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (4)

1.一种无人天车运行过程中的防摇摆控制方法，其特征在于：根据无人天车运行过程的吊具摇摆偏移量进行速度与加速度的自动调整，包括以下步骤：

步骤1：定义无人天车运行方向坐标系，包括：

无人天车运行方向包括大车运动方向、小车运动方向、吊具运动方向以及吊具相对小车转动方向四个自由度，以无人天车HOME位为原点、大车前进方向为X轴正向、小车前进方向为Y轴正向建立平行于水平面的天车运行坐标系；

步骤2：设置防摇摆控制周期为T，即按照T间隔周期实施控制，包括：

实时测量获取无人天车T_n-1时刻的大车位置，小车位置，大车速度V_XTn-1，小车速度V_YTn-1，以及无人天车T_n时刻的大车位置，小车位置，大车速度V_XTn，小车速度V_YTn；其中，n表示任意指定的某一参考时刻；

步骤3：根据大车速度从V_XTn-1到V_XTn的变化，根据公式(1)计算大车加速度a_XTn，包括：

a_XTn＝(V_XTn-V_XTn-1)/T (1)

根据小车速度从V_YTn-1到V_YTn的变化，根据公式(2)计算小车加速度a_YTn：

a_YTn＝(V_YTn-V_YTn-1)/T (2)

加速度计算完成的同时，也得到了加速度的方向；

步骤4：通过摆角检测仪实测角度信息，计算吊具相对于天车空间位置的相对偏移量，包括吊具X轴偏移程度X_Tn和吊具Y轴偏移程度Y_Tn；

步骤5：基于模糊控制方法，根据吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向确定，建立模糊控制模型获得大车加速度调节增益系数P_XTn；根据吊具Y轴偏离程度、小车加速度方向、吊具Y轴偏离方向确定，建立模糊控制模型获得小车加速度调节增益系数P_YTn；

步骤6：将吊具X轴偏移程度X_Tn乘以大车加速度调节增益系数P_XTn，根据公式(3)得到大车加速度调整量Δa_XTn：

Δa_XTn＝X_Tn×P_XTn (3)

将吊具Y轴偏移程度Y_Tn乘以小车加速度调节增益系数P_YTn，根据公式(4)得到小车加速度调整量Δa_YTn：

Δa_YTn＝Y_Tn×P_YTn (4)

步骤7：通过大车Δa_XTn与小车加速度调整量Δa_YTn修正T_n+1时刻的加速度，根据公式(5)以及公式(6)得到：

a_XTn+1＝a_XTn+Δa_XTn (5)

a_YTn+1＝a_YTn+Δa_YTn (6)

至此，完成了根据摇摆偏移量的天车加速度调整控制。

2.根据权利要求1所述的一种无人天车运行过程中的防摇摆控制方法，其特征在于：步骤4中，通过摆角检测仪实测角度信息，计算吊具X轴偏移程度X_Tn和吊具Y轴偏移程度Y_Tn，包括：

将小车水平面按XY轴分为Ⅰ、Ⅱ、Ⅲ、Ⅳ四个象限，主钩钢丝绳长度为L，L在XZ平面投影为L_xz，L_xz在XZ平面与Z轴的夹角为α₁，L在YZ平面上投影为L_yz，L_yz在YZ平面与Z轴的夹角为α₂，夹角α₁与α₂即为摆角检测仪实测角度；

根据公式(7)以及公式(8)，计算T_n时刻吊具X轴偏移程度X_Tn和吊具Y轴偏移程度Y_Tn：

X_Tn＝L_xz·sinα₁ (7)

Y_Tn＝L_yz·sinα₂ (8)

根据公式(9)以及公式(10)，由空间中存在的几何关系得到：

联立所述公式(9)以及公式(10)解得吊具X轴偏移程度X_Tn和吊具Y轴偏移程度Y_Tn分别与夹角α₁、α₂之间的关系式：

由此，根据摆角检测仪实测角度α₁、α₂计算出吊具X轴偏移程度X_Tn、吊具Y轴偏移程度Y_Tn。

3.根据权利要求1或2所述的一种无人天车运行过程中的防摇摆控制方法，其特征在于：所述步骤5中，基于模糊控制方法，获得大车加速度调节增益系数P_XTn，包括：

步骤5.1：确定输入、输出变量的模糊子集，包括：

包括吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向和大车加速度调节增益系数，模糊子集取值设定如下：

吊具X轴偏离程度X_Tn在模糊运算中记为S，设定其模糊子集m_S为：{大，中，小}；

大车加速度方向在模糊运算中记为D，设定其模糊子集m_D为：{正，负}；

吊具X轴偏离方向在模糊运算中记为W，设定其模糊子集m_W为：{正，负}；

大车加速度调节增益系数P_XTn在模糊运算中记为Q，设定其模糊子集m_Q为：{大大，中大，小大，大小，中小，小小}；

步骤5.2：变量模糊化，包括：

吊具X轴偏离程度S的基本物理论域为设定的最小值到最大值取值区间[Sv_min，Sv_max]，大车加速度方向D的基本物理论域为{-1，1}，吊具X轴偏离方向W的基本物理论域为{-1，1}，大车加速度调节增益系数Q的基本物理论域为[Qv_min，Qv_max]；

将基本物理论域转化为以离散自然数方式描述的模糊值域，实现变量模糊化；吊具X轴偏离程度S的模糊值域为{1,…,E_S}，吊具X轴偏离程度S的模糊值e_S的转化公式如下：

吊具X轴偏离程度S即为步骤4计算出的吊具X轴偏移程度X_Tn，模糊集最大值E_S取为3，即吊具偏离程度S的模糊值e_S∈{1,2,3}；

大车加速度方向D的模糊值域为{-1,1}，大车加速度方向D的模糊值e_D等于大车加速度方向取值：

e_D＝D (14)

即大车加速度方向D的模糊值e_D∈{-1,1}；

吊具X轴偏离方向W的模糊值域为{-1,1}，吊具X轴偏离方向W的模糊值e_W等于吊具X轴偏离方向取值：

e_W＝W (15)

即吊具X轴偏离程度W的模糊值e_W∈{-1,1}；

大车加速度调节增益系数Q的模糊值域为{0,1,…,E_Q}，大车加速度调节增益系数Q的模糊值e_Q的转化公式如下：

模糊集最大值E_Q取为6，即大车加速度调节增益系数Q的模糊值e_Q∈{0,1,2,3,4,5,6}；

步骤5.3：设定模糊值域对模糊子集的隶属度，包括：

针对各变量设定模糊值域对模糊子集的隶属度，吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度分别定义为μ_S、μ_D、μ_W、μ_Q；分别确定吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度；

步骤5.4：建立大车加速度调节增益系数的模糊控制规则表；

步骤5.5：建立模糊关系矩阵，包括：

所述模糊控制规则表包括12条规则，形成模糊关系矩阵R，所述模糊关系矩阵R为每一条规则对应子矩阵R_i的合成；子矩阵R_i为对应子规则i中吊具X轴偏离程度的隶属度矩阵μ_Si、大车加速度方向的隶属度矩阵μ_Di、吊具X轴偏离方向的隶属度矩阵μ_Wi、大车加速度调节增益系数的隶属度矩阵μ_Qi四者之间的直积运算：

R_i＝μ_Si×μ_Di×μ_Wi×μ_Qi，i＝1,2,…,12 (17)

对子矩阵R_i进行合并运算，得到模糊关系矩阵R，

即模糊关系矩阵R中任意位置元素，为所有12个子矩阵R_i中相同位置元素的最大值；

基于所述吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向、大车加速度调节增益系数的隶属度值，计算得到模糊关系矩阵R；

步骤5.6：通过模糊关系矩阵R求解大车加速度调节增益系数Q，包括：

通过吊具X轴偏离程度，大车加速度方向，吊具X轴偏离方向，参照公式(13)～公式(16)，分别转化模糊值e_S、e_D、e_W，并分别按照所述吊具X轴偏离程度、大车加速度方向、吊具X轴偏离方向的隶属度值，转化为隶属度矩阵μ_S ^*、μ_D ^*、μ_W ^*；

在此基础上，计算出大车加速度调节增益系数的隶属度矩阵μ_Q，如公式(20)所示：

μ_Q为一个1*7的行向量，在该行向量中的7个元素中比较获取到数值最大的元素所在列数L_Q，利用以下列数L_Q与模糊值e_Q的对应关系，求解e_Q；

e_Q＝L_Q-1 (21)

最后，将模糊值e_Q通过公式(16)计算得到大车加速度调节增益系数Q，即大车加速度调节增益系数P_XTn；

通过公式(22)利用模糊值e_Q计算得到大车加速度调节增益Q，即P_XTn：

4.根据权利要求3所述的一种无人天车运行过程中的防摇摆控制方法，其特征在于：步骤5中，采用与大车加速度调节增益系数P_XTn相同的方式获得小车加速度调节增益系数P_YTn。

Images