CN103809614A - 臂架控制方法及系统 - Google Patents

Abstract

本发明公开了一种臂架控制方法及系统。该臂架控制方法包括：a、获得臂架夹角与油缸位移的运动学方程以及油缸位移与臂架夹角的运动学方程；b、根据上述两个运动学方程得到臂架夹角角速度与油缸速度以及油缸速度与臂架夹角角速度的动力学关系；c、根据臂架夹角角速度与油缸速度以及油缸速度与臂架夹角角速度的动力学关系，预设平稳控制策略；d、根据当前的臂架夹角、控制输入信号和上述平稳控制策略，得到最优的油缸运动速度和运动时间；e、控制油缸按照所述油缸运动速度和所述运动时间动作。实施本发明，能够有效提高作业过程中臂架控制的连续性和平稳性，降低臂架控制过程对操作者的依赖，在提高泵送机械作业性能的同时降低了人工成本。

Description

臂架控制方法及系统

技术领域

本发明涉及机械臂控制技术领域，特别涉及一种臂架控制方法及系统。

背景技术

混凝土泵车等泵送机械是利用压力将混凝土沿管道连续输送的机械设备，一般由行走装置、泵送装置和臂架装置组成。其中，臂架装置由依次铰接相连的多节臂架组成，首节臂架的底端铰接于转台，首节臂架于转台之间以及相连两节臂架之间设置有油缸（可称为臂架油缸），用于调整首节臂架于转台的夹角以及相连两节臂架之间的夹角（可成为臂架夹角）；为了便于调节臂架夹角，在某些相邻的两个臂架之间采用多连杆机构，由臂架油缸调整连杆机构的变化以实现臂架夹角的变化。

另外，多节臂架上设置有与泵送装置连接的输送管，在工作过程中，当输送位置确定下来后，即可控制臂架装置带动输送管实现展开、收拢或者旋转等动作，以使末节臂架末端的输送管对准输送位置，从而实现输送。目前，臂架装置的控制通常依靠操作者与遥控装置配合完成。

通常，为了对末节臂架末端的位置进行控制，可建立整体臂架模型，并利用该整体臂架模型及臂架末端的目标位置，计算每一臂架在臂架末端运动至目标位置时的目标倾斜角（与各臂架夹角一一对应），之后通过施加控制电流，使臂架油缸伸出或缩回相应位移，以使每一臂架具有其目标倾斜角。在施加控制电流期间，需不断将安装于每一臂架上的倾角传感器所测的当前倾斜角反馈至控制器，该控制器将当前倾斜角与目标倾斜角进行比较，并根据比较结果对施加至臂架油缸的控制电流进行控制，直至每一臂架具有其目标倾斜角。

然而，由于整个臂架装置包括相连的多节臂架，具有很强的非线性，某些臂架姿态下，臂架前段产生的一个微小振动，经多节臂架传递至末节臂架时，将引起剧烈震荡，而且随着臂架姿态的不同，整个臂架装置的非线性性质也不相同，所以对臂架末端的位置进行精确控制且又能适应大部分姿态极为困难。

目前通过操作者与遥控装置配合的操控方式有利于操作者进行直观的判断，然而，为了保证整个臂架动作须有较大的连续性和平稳性，操作者需要有相应的经验积累以及在操控时需要投入极大的精力，不同操作者的操控水平不同，将使同一设备具有不同的作业效率，此外，若操控不稳，将容易导致臂架损伤和施工浪费。

因此，如何针对现有的上述不足进行改进，以便更加适应使用需要，是本领域技术人员亟待解决的技术问题。

发明内容

有鉴于此，本发明旨在提供一种臂架控制方法及系统，以便在控制过程中同时考虑臂架夹角与油缸位移以及油缸位移与臂架夹角的运动学和动力学信息，进而有效提高臂架动作的连续性和平稳性，有效降低臂架控制过程对操作者的依赖。

具体而言，本发明提供的臂架控制方法包括如下步骤：a、获得臂架夹角与油缸位移的运动学方程以及油缸位移与臂架夹角的运动学方程；b、根据上述两个运动学方程得到臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系；c、根据臂架夹角角速度与油缸速度以及油缸速度的动力学关系与臂架夹角角速度的动力学关系，预设平稳控制策略；d、根据当前的臂架夹角、控制输入信号和上述平稳控制策略，得到最优的油缸运动速度和运动时间；e、控制油缸按照所述油缸运动速度和所述运动时间动作。

进一步地，步骤a具体为：a1、通过顺序求解方式计算臂架夹角与油缸位移的第一实际关系式，将该第一实际关系式作为臂架夹角与油缸位移的运动学方程；a2、通过顺序求解方式计算油缸位移与臂架夹角的第二实际关系式，若能够计算出该第二实际关系式，则将其作为油缸位移与臂架夹角的运动学方程。

进一步地，步骤a2中还包括：a21、若无法计算出所述第二实际关系式，则根据所述第一实际关系式建立迭代函数，并根据该迭代函数得出油缸位移与臂架夹角的拟合函数，以及将该拟合函数作为油缸位移臂架夹角的运动学方程。

进一步地，b1、分析臂架夹角与油缸位移的运动学方程，得到臂架夹角角速度与油缸速度的关系；b2、分析油缸位移与臂架夹角的运动学方程，得到油缸速度与臂架夹角角速度的关系；b3、对臂架夹角角速度与油缸速度的关系以及油缸速度与臂架夹角角速度的关系进行采样，并存储为控制数据。

进一步地，步骤c具体为：c1、根据所述控制数据形成平稳控制策略，所述平稳控制策略包括：在预定范围的臂架夹角下，使油缸速度小于第一预设值，以免臂架角速度超过第二预设值。

进一步地，步骤d具体为：d1、获取当前的臂架夹角和控制输入信号；d2、计算在当前的臂架夹角下，符合所述平稳控制策略的最优的油缸运动速度，并根据控制输入信号计算油缸运动时间。

本发明提供的臂架控制系统包括：第一获取单元，用于获得臂架夹角与油缸位移的运动学方程以及油缸位移与臂架夹角的运动学方程；第二获取单元，用于根据上述两个运动学方程得到臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系；控制策略配置单元，用于根据臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系，预设平稳控制策略；第一处理单元，用于根据当前的臂架夹角、控制输入信号和上述平稳控制策略，得到最优的油缸运动速度和油缸运动时间；第二处理单元，用于控制油缸按照所述油缸运动速度和所述运动时间动作。

进一步地，所述第一获取单元包括：第一计算模块，用于通过顺序求解方式计算臂架夹角与油缸位移的第一实际关系式，将该第一实际关系式作为臂架夹角与油缸位移的运动学方程；第二计算模块，用于通过顺序求解方式计算油缸位移与臂架夹角的第二实际关系式，在能够计算出该第二实际关系式时，则将其作为油缸位移与臂架夹角的运动学方程。

进一步地，所述第一获取单元还包括：第三计算模块，用于在无法计算出所述第二实际关系式时，根据所述第一实际关系式建立迭代函数，并根据该迭代函数得出油缸位移与臂架夹角的拟合函数，以及将该拟合函数作为油缸位移与臂架夹角的运动学方程。

进一步地，所述第二获取单元包括：第一分析模块，用于分析臂架夹角与油缸位移的运动学方程，得到臂架夹角角速度与油缸速度的关系；第二分析模块，用于分析油缸位移与臂架夹角的运动学方程，得到油缸速度与臂架夹角角速度的关系；采样存储模块，用于对臂架夹角角速度与油缸速度的关系以及油缸速度与臂架夹角角速度的关系进行采样，并将采样结果存储为控制数据。

采用本发明的臂架控制方法或者臂架控制系统时，由于同时考虑了臂架夹角（夹角角速度）与油缸位移（速度）的动力学方程和动力学关系，以及油缸位移（速度）与臂架夹角（夹角角速度）的运动学方程和动力学关系，并将其作为平稳控制策略的配置依据，使得在控制过程中，当控制输入信号和当前的臂架夹角给定时，将能够得到符合平稳控制策略的最优的油缸运动速度和运动时间，这样可以避免油缸或者臂架夹角因变化过快而引起抖动、突变或者振荡现象，从而实现每一臂架夹角连续、平稳地变化到目标角度，与现有技术相比，有效提高了作业过程中臂架控制的连续性和平稳性，有效降低了臂架控制过程对操作者的依赖，在有效提高泵送机械作业性能的同时降低了人工成本。

附图说明

构成本发明的一部分的附图用来提供对本发明的进一步理解，本发明的示意性实施例及其说明用于解释本发明，并不构成对本发明的不当限定。在附图中：

图1为本发明实施例提供的一种臂架控制方法的流程示意图；

图2为图1中臂架夹角与油缸位移的运动学方程求解过程的一种臂架结构模型示意图；

图3为图1所示方式中油缸位移与臂架夹角的运动学方程求解过程的一种臂架结构模型示意图；

图4为无法通过顺序求解油缸位移与臂架夹角的实际关系式时的一种优选处理方式的流程示意图；

图5为按照图4所示方式得出的一种油缸位移与臂架夹角的拟合曲线示意图；

图6为图1中步骤S2的一种优选实现方式的流程示意图；

图7为本发明实施例提供的一种臂架控制系统的结构框图。

具体实施方式

应当指出，本部分中对具体结构的描述及描述顺序仅是对具体实施例的说明，不应视为对本发明的保护范围有任何限制作用。此外，在不冲突的情形下，本部分中的实施例以及实施例中的特征可以相互组合。

请参考图1至图7，下面将结合附图对本发明实施例作详细说明。

结合图1所示，本发明实施例的一种臂架控制方法可以包括如下步骤：S1、获得臂架夹角与油缸位移的运动学方程以及油缸位移与臂架夹角的运动学方程；S2、根据上述两个运动学方程得到臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系；S3、根据臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系，预设平稳控制策略；S4、根据当前的臂架夹角、控制输入信号和上述平稳控制策略，得到最优的油缸运动速度和运动时间；S5、控制油缸按照所述油缸运动速度和所述运动时间动作。

具体而言，在对整个臂架进行操控过程中，相邻两节臂架之间的夹角（即臂架夹角）是通过油缸驱动连杆机构实现的，对于不同的连杆机构或者不同的位姿，相同的臂架夹角控制量需要不同的油缸伸缩长度，在本实施例中，充分考虑了结构运动学，该结构运动学包括油缸位移（伸缩长度）与臂架夹角的双向运动学关系（即对应步骤S1中的两个运动学方程）；在得到双向运动学关系后，可以进一步得到双向动力学关系（如油缸速度与臂架夹角角速度的关系），进而能够为平稳控制策略的配置提供依据，以保证臂架控制过程平稳、连续。

这样当控制输入信号（如臂架夹角的目标角度）和当前的臂架夹角给定时，能够得到符合平稳控制策略的最优的油缸运动速度和运动时间，这样可以避免臂架夹角或者油缸因变化过快而引起抖动、突变或者振荡现象，从而实现每一臂架夹角连续、平稳地变化到目标角度，与现有技术相比，有效提高了作业过程中臂架控制的连续性和平稳性，有效降低了臂架控制过程对操作者的依赖，在有效提高泵送机械作业性能的同时降低了人工成本。

在具体实施时，上述实施例的步骤S1中，获得臂架夹角与油缸位移的运动学方程以及油缸位移与臂架夹角的运动学方程可以有不同方式，例如：若臂架夹角与油缸位移的运动学关系可以通过显示函数表示出来，则可以将该显示函数作为臂架夹角与油缸位移的运动学方程，若臂架夹角与油缸位移的运动学关系无法通过显示函数表示出来，则可以通过顺序求解方式得到臂架夹角与油缸位移的实际关系式（称为第一实际关系式），并将该第一实际关系式作为臂架夹角与油缸位移的运动学方程；若油缸位移与臂架夹角的实际关系式（称为第二实际关系式）可以通过顺序求解方式得到，则将该第二实际关系式作为油缸位移与臂架夹角的运动学方程，否则可以将油缸位移与臂架夹角的近似关系式作为油缸位移与臂架夹角的运动学方程。

例如，图2给出了臂架夹角与油缸位移的运动学方程求解过程的一种臂架结构模型示意图。其中，图2中每一个黑色圆点表示臂架、油缸和连杆机构的铰接点；铰接点之间的连线表示臂架、连杆和油缸，ou之间连线表示第一节臂架，zu之间的连线表示第二节臂架，sw之间的连线表示油缸，其他连线表示连杆机构的各连杆。为了便于表达，Dxy表示x点到y点的距离，Ang_ouz表示o点、u点、z点顺时针为边的夹角；因此，获得臂架夹角与油缸位移的运动学方程，就是求出Dsw的Ang_ouz表达式，其顺序求解方式如下：

Ang_wvx:=acos((Dvw*Dvw+Dvx*Dvx-Dwx*Dwx)/(2*Dvw*Dvx));

If Ang_ouz*pi/180+Ang_out+Ang_vuz>pi

Ang_tuv:=2*pi-Ang_out-Ang_vuz-Ang_ouz*pi/180;

else

Ang_tuv:=Ang_out+Ang_vuz+Ang_ouz*pi/180;

end

Dtv:=SQRT(Dtu*Dtu+Duv*Duv-2*cos(Ang_tuv)*Dtu*Duv);

Ang_utv:=acos((Dtu*Dtu+Dtv*Dtv-Duv*Duv)/(2*Dtu*Dtv));

Ang_vtx:=acos((Dtv*Dtv+Dtx*Dtx-Dvx*Dvx)/(2*Dtv*Dtx));

If Ang_ouz*pi/180+Ang_out+Ang_vuz>pi

Ang_utx:=Ang_vtx-Ang_utv;

else

Ang_utx:=Ang_vtx+Ang_utv;

end

Ang_tvx:=acos((Dtv*Dtv+Dvx*Dvx-Dtx*Dtx)/(2*Dtv*Dvx));

Ang_tvw:=Ang_tvx+Ang_wvx;

Dtw:=SQRT(Dtv*Dtv+Dvw*Dvw-2*cos(Ang_tvw)*Dtv*Dvw);

Ang_vtw:=acos((Dtv*Dtv+Dtw*Dtw-Dvw*Dvw)/(2*Dtv*Dtw));

Ang_wtx:=acos((Dtx*Dtx+Dtw*Dtw-Dwx*Dwx)/(2*Dtx*Dtw));

Ang_stw:=Ang_stu-Ang_wtx-Ang_utx;

Dsw:=SQRT(Dst*Dst+Dtw*Dtw-2*cos(Ang_stw)*Dst*Dtw);

另外，图3给出了油缸位移与臂架夹角的运动学方程求解过程的一种臂架结构模型示意图。其中，图3中每一个黑色圆点表示臂架、油缸和连杆机构的铰接点；铰接点之间的连线表示臂架、连杆和油缸，16之间连线表示第一节臂架，6c之间的连线表示第二节臂架，49之间的连线表示油缸，其他连线表示连杆机构的各连杆。为了便于表达，dxy表示x点到y点的距离，Ang_16c表示1点、6点、c点顺时针为边的夹角；因此，获得油缸位移与臂架夹角的运动学方程，就是求出Ang_16c的d49表达式，其顺序求解方式如下：

Ang_459=arcos((d45^2+d59^2-d49^2)/(2*d45*d59))；

Ang_859=13；

Ang_658=Ang_456-Ang_859-Ang_459；

d68=SQRT(d56^2+d58^2-cos(Ang_658)*2*d56*d58)；

Ang_568=arcos((d56^2+d68^2-d58^2)/(2*d56*d68))；

Ang_768=arcos((d76^2+d68^2-d78^2)/(2*d76*d68))；

Ang_16c=Ang_568+Ang_768-Ang_165-Ang_76c；

一般而言，若臂架夹角与油缸位移的运动学关系无法通过显示函数表示出来，可以通过图2所示的模型及对应的顺序求解方式得到。另外，对于一般连杆机构，油缸位移与臂架夹角的运动学关系可以通过图3所示的模型及对应的顺序求解方式得到，但是对于特殊的连杆机构，油缸位移与臂架夹角的运动学关系不但无法通过显示函数表示出来，更无法通过顺序求解方式表示，这种情形下，可以构建油缸位移与臂架夹角的近似关系式，并将其作为油缸位移与臂架夹角的运动方程，图4给出了一种实现该过程的优选方式。

结合图4所示，这种优选方式包括步骤：S11、无法通过顺序求解；S12、建立迭代函数关系；S13、函数变量数据采样；S14、函数拟合；S15、是否满足精度要求；S16、提高拟合函数阶数；S17、输出结果。

具体而言，当无法通过顺序求解方式得到油缸位移与臂架夹角的实际关系式时，可以采用迭代法（如牛顿迭代法、牛顿下山迭代法等实现）得到近似关系式，即可以根据臂架夹角与油缸位移的实际关系式构建相应的迭代函数关系，之后对函数变量进行数据采样，得到一组油缸位移值以及对应的一组臂架夹角值，之后采用曲线拟合方法得到油缸位移与臂架夹角的拟合函数（近似关系式），且当需要提高精度时，可以通过提高拟合函数阶数（如高阶项阶数）实现，另外，精度误差准则可以根据需要采用误差平方和最小准则、最大误差最小准则或者误差的绝对值和最小准则。

应当指出的是，拟合函数可以采用多项式函数、三角函数等；此外，通过设定相应的精度要求及相应误差准则，由此得到油缸位移与臂架夹角的近似关系式能够满足控制的需要。例如，图5给出了按照迭代法得到的拟合曲线（虚线部分），通过提高高阶项阶数，可以提高曲线的拟合精度。

另外，具体实施时，上述实施例的步骤S2中，由于已得到臂架夹角与油缸位移的运动学方程以及油缸位移与臂架夹角的运动学方程，两个运动学方程中分别蕴含了臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系，因而通过分析两个运动学方程，可以分别得出对应的动力学关系，以便为之后的控制步骤做准备。

例如，图6给出了步骤S2的一种优选方式，该优选方式包括：S21、分析臂架夹角角速度与油缸速度的动力学关系；S22、分析油缸速度与臂架夹角角速度的动力学关系；S23、确定采样时间；S24、记录数据变化；S25、建立数据库；S26、描绘曲线；S27、输出结果。具体地，首先分析臂架夹角与油缸位移的运动学方程，得到臂架夹角角速度与油缸速度的关系，以及分析油缸位移与臂架夹角的运动学方程，得到油缸速度与臂架夹角角速度的关系；之后确定采用时间，对油缸速度与臂架角速度的关系式进行采样，以及对臂架夹角角速度与油缸速度的关系式进行采样，分别记录两组数据变化，并将采样结果在数据库中存储为控制数据，同时数据变化可以以曲线的形式输出，供操作人员参考。这样，采用这种方式后，能够得到臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系，并以可调用的控制数据形式存储下来。

在此基础上，可根据上述控制数据配置相应的平稳控制策略（对应于上述实施例的步骤S3的实施过程中，），由于这些控制数据蕴含了油缸速度与臂架夹角角速度的关系以及臂架夹角角速度与油缸速度的关系，配置后的平稳控制策略可以作为油缸控制的依据，例如，该平稳控制策略包括：在某个（预定范围内）的臂架夹角下，使油缸速度小于第一预设值，以免臂架角速度超过第二预设值，从而避免臂架在收展过程中出现抖动、突变现象。这样在上述实施例的步骤S4的实施过程中，当收到当前的臂架夹角（可通过设置于臂架上的角度传感器实时测量）和控制输入信号后，即可计算在当前的臂架夹角下，符合平稳控制策略的最优的油缸运动速度，还可以根据控制输入信号计算油缸运动时间，由此得到的油缸运动速度和油缸运动时间经步骤S5执行后将使油缸能够平稳、连续地驱动臂架夹角发生变化。

请参见图7所示，本发明实施例还提供了一种臂架控制系统10，如图所示，该臂架控制系统10包括：第一获取单元101、第二获取单元102、控制策略配置单元103、第一处理单元104和第二处理单元105。

其中，第一获取单元101用于获得臂架夹角与油缸位移的运动学方程以及油缸位移与臂架夹角的运动学方程；第二获取单元102用于根据上述两个运动学方程得到臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系；控制策略配置单元103用于根据臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系，预设平稳控制策略；第一处理单元104用于根据当前的臂架夹角、控制输入信号和上述平稳控制策略，得到最优的油缸运动速度和油缸运动时间；第二处理单元105用于控制油缸按照所述油缸运动速度和所述运动时间动作。

在具体实施过程中，上述实施例的臂架控制系统104可以作如下至少一种优化：一、第一获取单元101可以进一步包括第一计算模块1011、第二计算模块1012和第三计算模块1013，其中，第一计算模块1011用于通过顺序求解方式计算臂架夹角与油缸位移的第一实际关系式，将该第一实际关系式作为臂架夹角与油缸位移的运动学方程；第二计算模块1012用于通过顺序求解方式计算油缸位移与臂架夹角的第二实际关系式，在能够计算出该第二实际关系式时，将其作为油缸位移与臂架夹角的运动学方程；第三计算模块1013用于在无法计算出所述第二实际关系式时，根据所述第一实际关系式建立迭代函数，并根据该迭代函数得出油缸位移与臂架夹角的拟合函数，以及将该拟合函数作为油缸位移与臂架夹角的运动学方程；若能够通过顺序求解方式计算出油缸位移与臂架夹角的第二实际关系式，第三计算模块1013也可以省略；二、第二获取单元102可以进一步包括第一分析模块1021、第二分析模块1022和采样存储模块1023，其中，第一分析模块1021用于分析臂架夹角与油缸位移的运动学方程，得到臂架夹角角速度与油缸速度的关系，第二分析模块1022用于分析油缸位移与臂架夹角的运动学方程，得到油缸速度与臂架夹角角速度的关系；采样存储模块1023用于对臂架夹角角速度与油缸速度的关系以及臂架夹角角速度与油缸速度的关系进行采样，并将采样结果存储为控制数据。

有关顺序求解方式的优选求解过程、采用迭代法计算油缸位移与臂架夹角近似关系的过程、平稳控制策略的配置方式可参见上一实施例（臂架控制方法）中的相关描述，在此不再赘述。

本领域普通技术人员可以理解，实现上述实施例的全部或者部分步骤/单元/模块可以通过程序指令相关的硬件来完成，前述程序可以存储于计算机可读取存储介质中，该程序在执行时，执行包括上述方法实施例的步骤；而前述的存储介质包括：ROM、RAM、磁碟或者光碟等各种可以存储程序代码的介质。

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

Claims (10)

1.一种臂架控制方法，其特征在于，包括如下步骤：

a、获得臂架夹角与油缸位移的运动学方程以及油缸位移与臂架夹角的运动学方程；

b、根据上述两个运动学方程得到臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系；

c、根据臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系，预设平稳控制策略；

d、根据当前的臂架夹角、控制输入信号和上述平稳控制策略，得到最优的油缸运动速度和运动时间；

e、控制油缸按照所述油缸运动速度和所述运动时间动作。

2.如权利要求1所述的臂架控制方法，其特征在于，步骤a具体为：

a1、通过顺序求解方式计算臂架夹角与油缸位移的第一实际关系式，将该第一实际关系式作为臂架夹角与油缸位移的运动学方程；

a2、通过顺序求解方式计算油缸位移与臂架夹角的第二实际关系式，若能够计算出该第二实际关系式，则将其作为油缸位移与臂架夹角的运动学方程。

3.如权利要求2所述的臂架控制方法，其特征在于，步骤a2中还包括：

a21、若无法计算出所述第二实际关系式，则根据所述第一实际关系式建立迭代函数，并根据该迭代函数得出油缸位移与臂架夹角的拟合函数，以及将该拟合函数作为油缸位移与臂架夹角的运动学方程。

4.如权利要求1所述的臂架控制方法，其特征在于，步骤b具体为：

b1、分析臂架夹角与油缸位移的运动学方程，得到臂架夹角角速度与油缸速度的关系；

b2、分析油缸位移与臂架夹角的运动学方程，得到油缸速度与臂架夹角角速度的关系；

b3、对臂架夹角角速度与油缸速度的关系以及油缸速度与臂架夹角角速度的关系进行采样，并将采样数据存储为控制数据。

5.如权利要求4所述的臂架控制方法，其特征在于，步骤c具体为：

c1、根据所述控制数据形成平稳控制策略，所述平稳控制策略包括：在预定范围的臂架夹角下，使油缸速度小于第一预设值，以免臂架夹角角速度超过第二预设值。

6.如权利要求5所述的臂架控制方法，其特征在于，步骤d具体为：

d1、获取当前的臂架夹角和控制输入信号；

d2、计算在当前的臂架夹角下，符合所述平稳控制策略的最优的油缸运动速度，并根据控制输入信号计算油缸运动时间。

7.一种臂架控制系统，其特征在于，所述臂架控制系统包括：

第一获取单元，用于获得臂架夹角与油缸位移的运动学方程以及油缸位移与臂架夹角的运动学方程；

第二获取单元，用于根据上述两个运动学方程得到臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系；

控制策略配置单元，用于根据臂架夹角角速度与油缸速度的动力学关系以及油缸速度与臂架夹角角速度的动力学关系，预设平稳控制策略；

第一处理单元，用于根据当前的臂架夹角、控制输入信号和上述平稳控制策略，得到最优的油缸运动速度和油缸运动时间；

第二处理单元，用于控制油缸按照所述油缸运动速度和所述运动时间动作。

8.如权利要求7所述的臂架控制系统，其特征在于，所述第一获取单元包括：

第一计算模块，用于通过顺序求解方式计算臂架夹角与油缸位移的第一实际关系式，将该第一实际关系式作为臂架夹角与油缸位移的运动学方程；

第二计算模块，用于通过顺序求解方式计算油缸位移与臂架夹角的第二实际关系式，在能够计算出该第二实际关系式时，则将其作为油缸位移与臂架夹角的运动学方程。

9.如权利要求8所述的臂架控制系统，其特征在于，所述第一获取单元还包括：

第三计算模块，用于在无法计算出所述第二实际关系式时，根据所述第一实际关系式建立迭代函数，并根据该迭代函数得出油缸位移与臂架夹角的拟合函数，以及将该拟合函数作为油缸位移与臂架夹角的运动学方程。

10.如权利要求7至9任一项所述的臂架控制系统，其特征在于，所述第二获取单元包括：

第一分析模块，用于分析臂架夹角与油缸位移的运动学方程，得到臂架夹角角速度与油缸速度的关系；

第二分析模块，用于分析油缸位移与臂架夹角的运动学方程，得到油缸速度与臂架夹角角速度的关系；

采样存储模块，用于对臂架夹角角速度与油缸速度的关系以及油缸速度与臂架夹角角速度的关系进行采样，并将采样结果存储为控制数据。

Images