CN113127974B - 一种动力学参数识别的方法、参数识别装置及存储介质 - Google Patents
一种动力学参数识别的方法、参数识别装置及存储介质 Download PDFInfo
- Publication number
- CN113127974B CN113127974B CN202110421669.8A CN202110421669A CN113127974B CN 113127974 B CN113127974 B CN 113127974B CN 202110421669 A CN202110421669 A CN 202110421669A CN 113127974 B CN113127974 B CN 113127974B
- Authority
- CN
- China
- Prior art keywords
- concrete pump
- pump truck
- coordinate system
- axis
- cantilever crane
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/10—Geometric CAD
- G06F30/15—Vehicle, aircraft or watercraft design
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2119/00—Details relating to the type or aim of the analysis or the optimisation
- G06F2119/14—Force analysis or force optimisation, e.g. static or dynamic forces
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Geometry (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Computational Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- General Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- On-Site Construction Work That Accompanies The Preparation And Application Of Concrete (AREA)
Abstract
本发明实施例公开了一种动力学参数识别的方法、参数识别装置及存储介质,用于快速、准确地识别混凝土泵车臂架系统的动力学参数。本发明实施例方法包括:使用DH法,建立混凝土泵车臂架系统的DH模型;根据所述DH模型和所述混凝土泵车臂架系统的实际尺寸,得到相应的DH参数;根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程;对所述动力学方程进行变形处理,得到AX=B表达式,其中X向量均由待求的混凝土泵车臂架系统动力学参数组成;根据所述AX=B表达式,利用最小二乘法,得到所述混泥土泵车臂架系统动力学参数的求解公式。
Description
技术领域
本发明涉及混凝土泵车臂架系统领域,尤其涉及一种动力学参数识别的方法、参数识别装置及存储介质。
背景技术
随着中国整个社会的进步与发展,国内的建筑行业得到了飞速发展,其中摩天大楼的数量位居世界第二,高数公路的里程数位居世界第一,桥梁数目位居世界第三。在各种大楼、桥梁、道路等的浇筑中,都离不开混凝土泵车,因此在近几年的时间里,也带来了混凝土泵车的飞速发展。混凝土泵车的臂架系统,作为混凝土泵车的关键部分,直接影响着浇筑的质量和浇筑的安全性。混凝土泵车臂架系统在做浇筑作业的时候,需要对混凝土泵车臂架系统的运动进行控制,特别是在满排量的时候混凝土泵车臂架系统会有振动,而在对混凝土泵车臂架系统的进行控制的时候,关键是要得到混凝土泵车臂架系统的动力学参数,其动力学参数的准确性直接影响着混凝土泵车臂架系统的运动精度的控制。而现有的动力学参数都不够准确。
发明内容
本发明实施例提供了一种动力学参数识别的方法、参数识别装置及存储介质,用于快速、准确地识别混凝土泵车臂架系统的动力学参数。
本发明第一方面提供一种动力学参数识别的方法,可以包括:
使用DH法,建立混凝土泵车臂架系统的DH模型;
根据所述DH模型和所述混凝土泵车臂架系统的实际尺寸,得到相应的DH参数;
根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程;
对所述动力学方程进行变形处理,得到AX=B表达式,其中X向量均由待求的混凝土泵车臂架系统动力学参数组成;
根据所述AX=B表达式,利用最小二乘法,得到所述混泥土泵车臂架系统动力学参数的求解公式。
可选的,所述DH模型包括DH坐标系,所述DH坐标系的z轴为混凝土泵车两个连杆间的旋转轴线方法向,坐标系的x轴为沿着连杆方向,从前一个关节指向后一个关节,坐标系的y轴与x轴和z轴之间遵从右手系原则。
可选的,所述DH参数包括:连杆长度a,连杆偏距d,转角α,关节角θ;
所述连杆长度a大小为沿着x轴方向,从前一个关节轴线到后一个关节轴线之间的距离;
所述连杆偏距d大小为沿着z轴方向,从所述DH坐标系的x轴到下一个坐标系的x轴之间的距离;
所述转角α大小为绕着坐标轴x,遵从右手螺旋定则,从所述DH坐标系中z轴旋转到下一个坐标系z轴之间的角度;
所述关节角θ大小为绕着坐标系中的z轴,遵从右手螺旋定则,从所述DH坐标系中的x轴旋转到下一个坐标系中的x轴之间的角度。
可选的,所述根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程,包括:
将所述DH参数代入到前一个坐标系相对后一个坐标系之间的旋转变换矩阵中得到旋转变换矩阵,根据旋转变换矩阵,得到各个连杆的质心相对于基坐标系的坐标向量;
根据所述各个连杆质心相对于基坐标系的坐标向量,得到各个臂杆质心相对于基坐标系的速度矩阵;
根据所述各个连杆质心相对于基坐标系的速度矩阵,求解得到所述混凝土泵车臂架系统的拉格朗日函数;
根据所述混凝土泵车臂架系统的拉格朗日函数,对其中的每个连杆进行求解,可以得到每个臂杆的拉格朗日方程组;
根据所述每个臂杆的拉格朗日方程组,利用矩阵的形式表达,得到所述混凝土泵车臂架系统的动力学方程。
可选的,所述前一个坐标系相对后一个坐标系之间的旋转变换矩阵的表达式为:
其中,第i个坐标系相对于第i-1个坐标系之间的旋转变换矩阵。
可选的,所述根据旋转变换矩阵,得到各个连杆的质心相对于基坐标系的坐标向量,包括:
Ri=[ri 0 0 1]T,其中Ri为第i个连杆的质心在第i个坐标系中的坐标向量;
求得各个连杆的质心相对于基坐标系的坐标向量。
可选的,所述根据所述各个连杆质心相对于基坐标系的速度矩阵,求解得到所述混凝土泵车臂架系统的拉格朗日函数,包括:
获取所述混凝土泵车臂架系统的总动能,所述总动能包括转台绕自身旋转轴旋转的旋转动能、连杆做平动运动的平动动能和连杆绕各自质心做旋转运动的转动动能;
获取所述混凝土泵车臂架系统的总势能,总势能包括连杆的重力势能和每两个连杆之间的弹性势能;
根据所述混凝土泵车臂架系统的总动能和所述混凝土泵车臂架系统的总势能,得到所述混凝土泵车臂架系统的拉格朗日函数。
本申请第二方面提供一种参数识别装置,可以包括:
建立模块,用于使用DH法,建立混凝土泵车臂架系统的DH模型;
处理模块,用于根据所述DH模型和所述混凝土泵车臂架系统的实际尺寸,得到相应的DH参数;根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程;对所述动力学方程进行变形处理,得到AX=B表达式,其中X向量均由待求的混凝土泵车臂架系统动力学参数组成;根据所述AX=B表达式,利用最小二乘法,得到所述混泥土泵车臂架系统动力学参数的求解公式。
可选的,所述DH模型包括DH坐标系,所述DH坐标系的z轴为混凝土泵车两个连杆间的旋转轴线方法向,坐标系的x轴为沿着连杆方向,从前一个关节指向后一个关节,坐标系的y轴与x轴和z轴之间遵从右手系原则。
可选的,所述DH参数包括:连杆长度a,连杆偏距d,转角α,关节角θ;
所述连杆长度a大小为沿着x轴方向,从前一个关节轴线到后一个关节轴线之间的距离;
所述连杆偏距d大小为沿着z轴方向,从所述DH坐标系的x轴到下一个坐标系的x轴之间的距离;
所述转角α大小为绕着坐标轴x,遵从右手螺旋定则,从所述DH坐标系中z轴旋转到下一个坐标系z轴之间的角度;
所述关节角θ大小为绕着坐标系中的z轴,遵从右手螺旋定则,从所述DH坐标系中的x轴旋转到下一个坐标系中的x轴之间的角度。
可选的,所述处理模块,具体用于:
将所述DH参数代入到前一个坐标系相对后一个坐标系之间的旋转变换矩阵中得到旋转变换矩阵,根据旋转变换矩阵,得到各个连杆的质心相对于基坐标系的坐标向量;
根据所述各个连杆质心相对于基坐标系的坐标向量,得到各个臂杆质心相对于基坐标系的速度矩阵;
根据所述各个连杆质心相对于基坐标系的速度矩阵,求解得到所述混凝土泵车臂架系统的拉格朗日函数;
根据所述混凝土泵车臂架系统的拉格朗日函数,对其中的每个连杆进行求解,可以得到每个臂杆的拉格朗日方程组;
根据所述每个臂杆的拉格朗日方程组,利用矩阵的形式表达,得到所述混凝土泵车臂架系统的动力学方程。
可选的,所述前一个坐标系相对后一个坐标系之间的旋转变换矩阵的表达式为:
其中,第i个坐标系相对于第i-1个坐标系之间的旋转变换矩阵。
可选的,所述处理模块,具体用于:
Ri=[ri0 0 1]T,其中Ri为第i个连杆的质心在第i个坐标系中的坐标向量;
求得各个连杆的质心相对于基坐标系的坐标向量。
可选的,所述处理模块,具体用于:
获取所述混凝土泵车臂架系统的总动能,所述总动能包括转台绕自身旋转轴旋转的旋转动能、连杆做平动运动的平动动能和连杆绕各自质心做旋转运动的转动动能;
获取所述混凝土泵车臂架系统的总势能,总势能包括连杆的重力势能和每两个连杆之间的弹性势能;
根据所述混凝土泵车臂架系统的总动能和所述混凝土泵车臂架系统的总势能,得到所述混凝土泵车臂架系统的拉格朗日函数。
本申请第三方面提供一种参数识别装置,可以包括:
存储有可执行程序代码的存储器;
与所述存储器耦合的处理器;
所述处理器调用所述存储器中存储的所述可执行程序代码,用于执行如本申请第一方面所述的方法。
本申请第四方面提供一种计算机可读存储介质,包括指令,当其在处理器上运行时,使得处理器执行如本申请第一方面所述的方法。
本发明实施例又一方面公开一种计算机程序产品,当所述计算机程序产品在计算机上运行时,使得所述计算机执行本申请第一方面所述的方法。
本发明实施例又一方面公开一种应用发布平台,所述应用发布平台用于发布计算机程序产品,其中,当所述计算机程序产品在计算机上运行时,使得所述计算机执行本申请第一方面所述的方法。
从以上技术方案可以看出,本发明实施例具有以下优点:
在本发明实施例中,使用DH法,建立混凝土泵车臂架系统的DH模型;根据所述DH模型和所述混凝土泵车臂架系统的实际尺寸,得到相应的DH参数;根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程;对所述动力学方程进行变形处理,得到AX=B表达式,其中X向量均由待求的混凝土泵车臂架系统动力学参数组成;根据所述AX=B表达式,利用最小二乘法,得到所述混泥土泵车臂架系统动力学参数的求解公式。用于快速、准确地识别混凝土泵车臂架系统的动力学参数。同时又要实现在线辨识,采用最小二乘法对其动力学参数进行识别是比较好的选择。
附图说明
为了更清楚地说明本发明实施例技术方案,下面将对实施例和现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,还可以根据这些附图获得其它的附图。
图1为本申请中动力学参数识别的方法的一个实施例示意图;
图2为本发明实施例提供的一种参数识别装置的一个示意图;
图3为本发明实施例提供的一种参数识别装置的另一个示意图;
图4为本发明实施例提供的一种电子设备的一个示意图。
具体实施方式
本发明实施例提供了一种动力学参数识别的方法、参数识别装置及存储介质,用于快速、准确地识别混凝土泵车臂架系统的动力学参数。
为了使本技术领域的人员更好地理解本发明方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行描述,显然,所描述的实施例仅仅是本发明一部分的实施例,而不是全部的实施例。基于本发明中的实施例,都应当属于本发明保护的范围。
混凝土泵车在作业的时候,其臂架的姿态在不停地变化,则其动力学参数也在不停地改变,为此需要对混凝土泵车臂架系统的动力学参数进行在线辨识,同时由于混凝土泵车臂架系统的杆件比较多,有5-8根,所以传感器采集的数据量也很多,通过以上分析可得,为了要快速、准确地识别混凝土泵车臂架系统的动力学参数,同时又要实现在线辨识,采用最小二乘法对其动力学参数进行识别是最佳选择。在利用最小二乘法对混凝土泵车臂架系统动力学参数进行求解时,关键是要得到AX=B形式的动力学方程,为此本发明提供了一种得到AX=B形式动力学方程的方法。
下面以实施例的方式,对本申请技术方案做进一步的说明,如图1所示,为本申请中动力学参数识别的方法的一个实施例示意图,可以包括:
101、使用DH法,建立混凝土泵车臂架系统的DH模型。
可选的,所述DH模型包括DH坐标系,所述DH坐标系的z轴为混凝土泵车两个连杆间的旋转轴线方法向,坐标系的x轴为沿着连杆方向,从前一个关节指向后一个关节,坐标系的y轴与x轴和z轴之间遵从右手系原则。
102、根据所述DH模型和所述混凝土泵车臂架系统的实际尺寸,得到相应的DH参数。
可选的,所述DH参数包括:连杆长度a,连杆偏距d,转角α,关节角θ:
所述连杆长度a大小为沿着x轴方向,从前一个关节轴线到后一个关节轴线之间的距离;
所述连杆偏距d大小为沿着z轴方向,从所述DH坐标系的x轴到下一个坐标系的x轴之间的距离;
所述转角α大小为绕着坐标轴x,遵从右手螺旋定则,从所述DH坐标系中z轴旋转到下一个坐标系z轴之间的角度;
所述关节角θ大小为绕着坐标系中的z轴,遵从右手螺旋定则,从所述DH坐标系中的x轴旋转到下一个坐标系中的x轴之间的角度。
可以理解的是,在以上四个DH参数中,除了最后一个关节角θ外,其他三个DH参数均为定值,其值的大小和混凝土泵车臂架系统的臂杆的实际几何尺寸相关,关节角θ的大小取决于相邻两个臂架之间的旋转角度的大小。
103、根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程。
所述根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程,可以包括:
将所述DH参数代入到前一个坐标系相对后一个坐标系之间的旋转变换矩阵中得到旋转变换矩阵,根据旋转变换矩阵,得到各个连杆的质心相对于基坐标系的坐标向量;根据所述各个连杆质心相对于基坐标系的坐标向量,得到各个臂杆质心相对于基坐标系的速度矩阵;根据所述各个连杆质心相对于基坐标系的速度矩阵,求解得到所述混凝土泵车臂架系统的拉格朗日函数;根据所述混凝土泵车臂架系统的拉格朗日函数,对其中的每个连杆进行求解,可以得到每个臂杆的拉格朗日方程组;根据所述每个臂杆的拉格朗日方程组,利用矩阵的形式表达,得到所述混凝土泵车臂架系统的动力学方程。
可选的,所述前一个坐标系相对后一个坐标系之间的旋转变换矩阵的表达式为:
其中,第i个坐标系相对于第i-1个坐标系之间的旋转变换矩阵。
可选的,所述根据旋转变换矩阵,得到各个连杆的质心相对于基坐标系的坐标向量,可以包括:
第i个坐标系对于基坐标系之间的旋转变换矩阵的计算表达式为:其中i=1,2,3,...6;Ri=[ri0 0 1]T,其中Ri为第i个连杆的质心在第i个坐标系中的坐标向量,Ri的形式为Ri=[ri 0 0 1]T;
可选的,所述根据所述各个连杆质心相对于基坐标系的速度矩阵,求解得到所述混凝土泵车臂架系统的拉格朗日函数,可以包括:获取所述混凝土泵车臂架系统的总动能,所述总动能包括转台绕自身旋转轴旋转的旋转动能、连杆做平动运动的平动动能和连杆绕各自质心做旋转运动的转动动能;获取所述混凝土泵车臂架系统的总势能,总势能包括连杆的重力势能和每两个连杆之间的弹性势能;根据所述混凝土泵车臂架系统的总动能和所述混凝土泵车臂架系统的总势能,得到所述混凝土泵车臂架系统的拉格朗日函数。
示例性的,对于混凝土泵车臂架系统的总动能包括6个臂杆平动的动能和6个臂杆绕各自旋转轴旋转的旋转动能,则其大小为:
对于混凝土泵车臂架系统,其总势能包括臂杆之间的弹性势能和臂杆的重力势能,则总势能大小计算公式为:
由总动能和总势能,则可以得到混凝土泵车臂架系统的拉格朗日函数,其表达式为:
拉格朗日函数,即:L=T-V
其中,T为总动能,V为总势能;
可以理解的是,在上一步中得到了整个臂架系统的拉格朗日函数基础中,对混凝土泵车臂架系统中的每一个连杆进行求解,可以得到每一个臂杆的拉格朗日方程组,其求解公式如下,其中θi为第i个连杆的角加速度大小;
在混凝土泵车臂架系统中,由于两个连杆之间的力矩主要是和速度相关的摩擦力矩和空气阻尼矩,假设用参数c来表示,则把i=1,2,…,6依次带入上面的公式中,可以得到如下所示的6个连杆的拉格朗日方程组:
采用矩阵的形式表达,则其动力学方程为:
[I]{θ}+[c]{θ}+[K]{θ}+[W]{m}=0。
在上述矩阵表达式中,各个矩阵的具体形式如下所示:
对于矩阵[W],其元素的具体形式为:
需要说明的是,在上一步中,得到了混凝土泵车臂架系统动力学方程的矩阵形式,为了能够利用最小二乘法的原理对混凝土泵车臂架系统的动力学参数进行求解,则要先对混凝土泵车臂架系统的动力学方程进行变形处理,将其动力学方程变成AX=B的形式,其中X向量为待求向量。首先将混凝土泵车臂架系统动力学方程变成令A=[[θ] [θ]],B=[W]{m}-[I]{θ},则把混凝土泵车臂架系统的动力学方程化成了AX=B的形式。其中:
X=[[k1 k2 … k6] [c1 c2 … c6]]T;
B中的各个向量和矩阵的表达式为:
104、对所述动力学方程进行变形处理,得到AX=B表达式,其中X向量均由待求的混凝土泵车臂架系统动力学参数组成。
105、根据所述AX=B表达式,利用最小二乘法,得到所述混泥土泵车臂架系统动力学参数的求解公式。
则混凝土泵车臂架系统的动力学参数求解公式为:X=(ATA)-1ATB。
利用角速度传感器,可以得到混泥土泵车臂架系统各个臂杆的角速度大小,通过积分即可得到其角度大小,通过微分,可得到其角加速度大小,则对于上述求解公式,A和B矩阵大小均可以得到。
在本发明实施例中,使用DH法,建立混凝土泵车臂架系统的DH模型;根据所述DH模型和所述混凝土泵车臂架系统的实际尺寸,得到相应的DH参数;根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程;对所述动力学方程进行变形处理,得到AX=B表达式,其中X向量均由待求的混凝土泵车臂架系统动力学参数组成;根据所述AX=B表达式,利用最小二乘法,得到所述混泥土泵车臂架系统动力学参数的求解公式。用于快速、准确地识别混凝土泵车臂架系统的动力学参数。同时又要实现在线辨识,采用最小二乘法对其动力学参数进行识别是比较好的选择。
如图2所示,为本发明实施例提供的一种参数识别装置的一个示意图,可以包括:
建立模块201,用于使用DH法,建立混凝土泵车臂架系统的DH模型;
处理模块202,用于根据所述DH模型和所述混凝土泵车臂架系统的实际尺寸,得到相应的DH参数;根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程;对所述动力学方程进行变形处理,得到AX=B表达式,其中X向量均由待求的混凝土泵车臂架系统动力学参数组成;根据所述AX=B表达式,利用最小二乘法,得到所述混泥土泵车臂架系统动力学参数的求解公式。
可选的,所述DH模型包括DH坐标系,所述DH坐标系的z轴为混凝土泵车两个连杆间的旋转轴线方法向,坐标系的x轴为沿着连杆方向,从前一个关节指向后一个关节,坐标系的y轴与x轴和z轴之间遵从右手系原则。
可选的,所述DH参数包括:连杆长度a,连杆偏距d,转角α,关节角θ;
所述连杆长度a大小为沿着x轴方向,从前一个关节轴线到后一个关节轴线之间的距离;
所述连杆偏距d大小为沿着z轴方向,从所述DH坐标系的x轴到下一个坐标系的x轴之间的距离;
所述转角a大小为绕着坐标轴x,遵从右手螺旋定则,从所述DH坐标系中z轴旋转到下一个坐标系z轴之间的角度;
所述关节角θ大小为绕着坐标系中的z轴,遵从右手螺旋定则,从所述DH坐标系中的x轴旋转到下一个坐标系中的x轴之间的角度。
可选的,处理模块202,具体用于:
将所述DH参数代入到前一个坐标系相对后一个坐标系之间的旋转变换矩阵中得到旋转变换矩阵,根据旋转变换矩阵,得到各个连杆的质心相对于基坐标系的坐标向量;
根据所述各个连杆质心相对于基坐标系的坐标向量,得到各个臂杆质心相对于基坐标系的速度矩阵;
根据所述各个连杆质心相对于基坐标系的速度矩阵,求解得到所述混凝土泵车臂架系统的拉格朗日函数;
根据所述混凝土泵车臂架系统的拉格朗日函数,对其中的每个连杆进行求解,可以得到每个臂杆的拉格朗日方程组;
根据所述每个臂杆的拉格朗日方程组,利用矩阵的形式表达,得到所述混凝土泵车臂架系统的动力学方程。
可选的,所述前一个坐标系相对后一个坐标系之间的旋转变换矩阵的表达式为:
其中,第i个坐标系相对于第i-1个坐标系之间的旋转变换矩阵。
可选的,处理模块202,具体用于:
Ri=[ri 0 0 1]T,其中Ri为第i个连杆的质心在第i个坐标系中的坐标向量;
求得各个连杆的质心相对于基坐标系的坐标向量。
可选的,处理模块202,具体用于:
获取所述混凝土泵车臂架系统的总动能,所述总动能包括转台绕自身旋转轴旋转的旋转动能、连杆做平动运动的平动动能和连杆绕各自质心做旋转运动的转动动能;
获取所述混凝土泵车臂架系统的总势能,总势能包括连杆的重力势能和每两个连杆之间的弹性势能;
根据所述混凝土泵车臂架系统的总动能和所述混凝土泵车臂架系统的总势能,得到所述混凝土泵车臂架系统的拉格朗日函数。
如图3所示,为本发明实施例提供的一种参数识别装置的另一个示意图,可以包括:
存储有可执行程序代码的存储器301;
与存储器301合的处理器302;
处理器302调用存储器301中存储的所述可执行程序代码,用于执行如下步骤:
使用DH法,建立混凝土泵车臂架系统的DH模型;
处理模块202,用于根据所述DH模型和所述混凝土泵车臂架系统的实际尺寸,得到相应的DH参数;根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程;对所述动力学方程进行变形处理,得到AX=B表达式,其中X向量均由待求的混凝土泵车臂架系统动力学参数组成;根据所述AX=B表达式,利用最小二乘法,得到所述混泥土泵车臂架系统动力学参数的求解公式。
可选的,所述DH模型包括DH坐标系,所述DH坐标系的z轴为混凝土泵车两个连杆间的旋转轴线方法向,坐标系的x轴为沿着连杆方向,从前一个关节指向后一个关节,坐标系的y轴与x轴和z轴之间遵从右手系原则。
可选的,所述DH参数包括:连杆长度a,连杆偏距d,转角α,关节角θ;
所述连杆长度a大小为沿着x轴方向,从前一个关节轴线到后一个关节轴线之间的距离;
所述连杆偏距d大小为沿着z轴方向,从所述DH坐标系的x轴到下一个坐标系的x轴之间的距离;
所述转角α大小为绕着坐标轴x,遵从右手螺旋定则,从所述DH坐标系中z轴旋转到下一个坐标系z轴之间的角度;
所述关节角θ大小为绕着坐标系中的z轴,遵从右手螺旋定则,从所述DH坐标系中的x轴旋转到下一个坐标系中的x轴之间的角度。
可选的,处理器302,具体用于:
将所述DH参数代入到前一个坐标系相对后一个坐标系之间的旋转变换矩阵中得到旋转变换矩阵,根据旋转变换矩阵,得到各个连杆的质心相对于基坐标系的坐标向量;
根据所述各个连杆质心相对于基坐标系的坐标向量,得到各个臂杆质心相对于基坐标系的速度矩阵;
根据所述各个连杆质心相对于基坐标系的速度矩阵,求解得到所述混凝土泵车臂架系统的拉格朗日函数;
根据所述混凝土泵车臂架系统的拉格朗日函数,对其中的每个连杆进行求解,可以得到每个臂杆的拉格朗日方程组;
根据所述每个臂杆的拉格朗日方程组,利用矩阵的形式表达,得到所述混凝土泵车臂架系统的动力学方程。
可选的,所述前一个坐标系相对后一个坐标系之间的旋转变换矩阵的表达式为:
其中,第i个坐标系相对于第i-1个坐标系之间的旋转变换矩阵。
可选的,处理器302,具体用于:
Ri=[ri 0 0 1]T,其中Ri为第i个连杆的质心在第i个坐标系中的坐标向量;
求得各个连杆的质心相对于基坐标系的坐标向量。
可选的,处理器302,具体用于:
获取所述混凝土泵车臂架系统的总动能,所述总动能包括转台绕自身旋转轴旋转的旋转动能、连杆做平动运动的平动动能和连杆绕各自质心做旋转运动的转动动能;
获取所述混凝土泵车臂架系统的总势能,总势能包括连杆的重力势能和每两个连杆之间的弹性势能;
根据所述混凝土泵车臂架系统的总动能和所述混凝土泵车臂架系统的总势能,得到所述混凝土泵车臂架系统的拉格朗日函数。
如图4所示,为本发明实施例提供的一种电子设备的一个示意图,可以包括如图2或图3所示的参数识别装置。
在上述实施例中,可以全部或部分地通过软件、硬件、固件或者其任意组合来实现。当使用软件实现时,可以全部或部分地以计算机程序产品的形式实现。
所述计算机程序产品包括一个或多个计算机指令。在计算机上加载和执行所述计算机程序指令时,全部或部分地产生按照本发明实施例所述的流程或功能。所述计算机可以是通用计算机、专用计算机、计算机网络、或者其他可编程装置。所述计算机指令可以存储在计算机可读存储介质中,或者从一个计算机可读存储介质向另一计算机可读存储介质传输,例如,所述计算机指令可以从一个网站站点、计算机、服务器或数据中心通过有线(例如同轴电缆、光纤、数字用户线(Digital Subscriber Line,DSL))或无线(例如红外、无线、微波等)方式向另一个网站站点、计算机、服务器或数据中心进行传输。所述计算机可读存储介质可以是计算机能够存储的任何可用介质或者是包含一个或多个可用介质集成的服务器、数据中心等数据存储设备。所述可用介质可以是磁性介质,(例如,软盘、硬盘、磁带)、光介质(例如,DVD)、或者半导体介质(例如固态硬盘(Solid State Disk,SSD))等。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的系统,装置和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
在本发明所提供的几个实施例中,应该理解到,所揭露的系统,装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-OnlyMemory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述,以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (10)
1.一种动力学参数识别的方法,其特征在于,包括:
使用DH法,建立混凝土泵车臂架系统的DH模型;
根据所述DH模型和所述混凝土泵车臂架系统的实际尺寸,得到相应的DH参数;
根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程;
对所述动力学方程进行变形处理,得到AX=B表达式,其中X向量均由待求的混凝土泵车臂架系统动力学参数组成;
根据所述AX=B表达式,利用最小二乘法,得到所述混凝土泵车臂架系统动力学参数的求解公式;
令A=[[θ] [θ]],B=[W]{m}-[I]{θ},则混凝土泵车臂架系统的动力学参数求解公式为:X=(ATA)-1ATB;利用角速度传感器,得到混凝 土泵车臂架系统各个臂杆的角速度大小,通过积分即可得到其角度大小,通过微分,得到其角加速度大小,则对于上述求解公式,A和B矩阵大小均可以得到;
2.根据权利要求1所述的方法,其特征在于,所述DH模型包括DH坐标系,所述DH坐标系的z轴为混凝土泵车两个连杆间的旋转轴线方法向,坐标系的x轴为沿着连杆方向,从前一个关节指向后一个关节,坐标系的y轴与x轴和z轴之间遵从右手系原则。
3.根据权利要求2所述的方法,其特征在于,所述DH参数包括:连杆长度a,连杆偏距d,转角α,关节角δ;
所述连杆长度a大小为沿着x轴方向,从前一个关节轴线到后一个关节轴线之间的距离;
所述连杆偏距d大小为沿着z轴方向,从所述DH坐标系的x轴到下一个坐标系的x轴之间的距离;
所述转角α大小为绕着坐标轴x,遵从右手螺旋定则,从所述DH坐标系中z轴旋转到下一个坐标系z轴之间的角度;
所述关节角δ大小为绕着坐标系中的z轴,遵从右手螺旋定则,从所述DH坐标系中的x轴旋转到下一个坐标系中的x轴之间的角度。
4.根据权利要求1-3中任一项所述的方法,所述根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程,包括:
将所述DH参数代入到前一个坐标系相对后一个坐标系之间的旋转变换矩阵中得到旋转变换矩阵,根据旋转变换矩阵,得到各个连杆的质心相对于基坐标系的坐标向量;
根据所述各个连杆质心相对于基坐标系的坐标向量,得到各个臂杆质心相对于基坐标系的速度矩阵;
根据所述各个连杆质心相对于基坐标系的速度矩阵,求解得到所述混凝土泵车臂架系统的拉格朗日函数;
根据所述混凝土泵车臂架系统的拉格朗日函数,对其中的每个连杆进行求解,可以得到每个臂杆的拉格朗日方程组;
根据所述每个臂杆的拉格朗日方程组,利用矩阵的形式表达,得到所述混凝土泵车臂架系统的动力学方程。
7.根据权利要求4所述的方法,其特征在于,所述根据所述各个连杆质心相对于基坐标系的速度矩阵,求解得到所述混凝土泵车臂架系统的拉格朗日函数,包括:
获取所述混凝土泵车臂架系统的总动能,所述总动能包括转台绕自身旋转轴旋转的旋转动能、连杆做平动运动的平动动能和连杆绕各自质心做旋转运动的转动动能;
获取所述混凝土泵车臂架系统的总势能,总势能包括连杆的重力势能和每两个连杆之间的弹性势能;
根据所述混凝土泵车臂架系统的总动能和所述混凝土泵车臂架系统的总势能,得到所述混凝土泵车臂架系统的拉格朗日函数。
8.一种参数识别装置,其特征在于,包括:
建立模块,用于使用DH法,建立混凝土泵车臂架系统的DH模型;
处理模块,用于根据所述DH模型和所述混凝土泵车臂架系统的实际尺寸,得到相应的DH参数;根据所述DH参数,利用拉格朗日法,求解得到所述混凝土泵车臂架系统的动力学方程;对所述动力学方程进行变形处理,得到AX=B表达式,其中X向量均由待求的混凝土泵车臂架系统动力学参数组成;根据所述AX=B表达式,利用最小二乘法,得到所述混凝土泵车臂架系统动力学参数的求解公式;
令A=[[θ] [θ]],B=[W]{m}-[I]{θ},则混凝土泵车臂架系统的动力学参数求解公式为:X=(ATA)-1ATB;利用角速度传感器,得到混凝 土泵车臂架系统各个臂杆的角速度大小,通过积分即可得到其角度大小,通过微分,得到其角加速度大小,则对于上述求解公式,A和B矩阵大小均可以得到;
9.一种参数识别装置,其特征在于,包括:
存储有可执行程序代码的存储器;
与所述存储器耦合的处理器;
所述处理器调用所述存储器中存储的所述可执行程序代码,用于执行如权利要求1-7中任一项所述的方法。
10.一种计算机可读存储介质,包括指令,当其在处理器上运行时,使得处理器执行如权利要求1-7中任一项所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110421669.8A CN113127974B (zh) | 2021-04-19 | 2021-04-19 | 一种动力学参数识别的方法、参数识别装置及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110421669.8A CN113127974B (zh) | 2021-04-19 | 2021-04-19 | 一种动力学参数识别的方法、参数识别装置及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113127974A CN113127974A (zh) | 2021-07-16 |
CN113127974B true CN113127974B (zh) | 2023-02-24 |
Family
ID=76778396
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110421669.8A Active CN113127974B (zh) | 2021-04-19 | 2021-04-19 | 一种动力学参数识别的方法、参数识别装置及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113127974B (zh) |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111400936A (zh) * | 2020-04-27 | 2020-07-10 | 无锡信捷电气股份有限公司 | 一种机器人动力学参数辨识方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102331720B (zh) * | 2011-09-20 | 2014-08-27 | 上海交通大学 | 基于Modelica语言的混凝土泵车臂架仿真系统的设计方法 |
CN103034123B (zh) * | 2012-12-11 | 2016-01-27 | 中国科学技术大学 | 基于动力学模型参数辨识的并联机器人控制方法 |
CN103809614A (zh) * | 2014-01-26 | 2014-05-21 | 三一汽车制造有限公司 | 臂架控制方法及系统 |
CN108972558B (zh) * | 2018-08-16 | 2020-02-21 | 居鹤华 | 一种基于轴不变量的多轴机器人动力学建模方法 |
CN110509276B (zh) * | 2019-08-28 | 2022-06-21 | 哈尔滨工程大学 | 一种机场跑道检测机器人的运动建模及参数辨识方法 |
-
2021
- 2021-04-19 CN CN202110421669.8A patent/CN113127974B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111400936A (zh) * | 2020-04-27 | 2020-07-10 | 无锡信捷电气股份有限公司 | 一种机器人动力学参数辨识方法 |
Non-Patent Citations (3)
Title |
---|
基于Matlab的IRB2400机器人轨迹规划及运动学分析;孙增光等;《山东理工大学学报(自然科学版)》;20200228;第34卷(第1期);P12-17 * |
基于辨识模型的机器人动力学控制技术的研究;袁野;《中国优秀硕士学位论文全文数据库 信息科技辑》;20210115(第01期);I140-767 * |
空间双臂机器人运动学及动力学分析与建模研究;吴长征等;《上海航天》;20170625;第34卷(第3期);P80-87 * |
Also Published As
Publication number | Publication date |
---|---|
CN113127974A (zh) | 2021-07-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6242591B2 (ja) | 仮想環境および物理環境における強化センサーによる位置特定 | |
CN113119098B (zh) | 机械臂控制方法、机械臂控制装置及终端设备 | |
CN107009350B (zh) | 一种3-prs串并联机构等效质量的确定方法 | |
CN104776822B (zh) | 多节臂架的姿态检测系统和方法 | |
CN108318027B (zh) | 载体的姿态数据的确定方法和装置 | |
WO2023197417A1 (zh) | 起重机稳定性分析方法、起重机防倾覆控制方法及装置 | |
Li et al. | A dynamic pre-travel error prediction model for the kinematic touch trigger probe | |
CN107539887A (zh) | 建筑施工塔吊机群防碰撞预警辅助系统 | |
CN113031579A (zh) | 双足机器人的行走控制方法、装置及双足机器人 | |
CN113127974B (zh) | 一种动力学参数识别的方法、参数识别装置及存储介质 | |
CN113119104B (zh) | 机械臂控制方法、机械臂控制装置、计算设备及系统 | |
CN112140111B (zh) | 机器人的末端负载质心的确定方法 | |
CN109866217B (zh) | 机器人里程定位方法、装置、终端设备及计算机存储介质 | |
Wang et al. | Effective inertial hand gesture recognition using particle filtering based trajectory matching | |
CN111890364B (zh) | 机器人的运动控制方法、装置、电子设备及存储介质 | |
Oh et al. | Dynamic displacements‐based model updating with motion capture system | |
CN111078029A (zh) | 空中鼠标信息确定方法、装置、设备及存储介质 | |
CN114674405B (zh) | 重力测量方法、装置、计算机设备和计算机可读存储介质 | |
CN113927585B (zh) | 一种机器人平衡控制方法、装置、可读存储介质及机器人 | |
CN112269187B (zh) | 机器人状态检测方法、装置及设备 | |
CN110328689B (zh) | 机器人平衡检测方法、装置、设备及机器人 | |
CN112784428B (zh) | 一种基于dh参数的混凝土泵车拉格朗日动力学建模方法 | |
CN114622617A (zh) | 作业机械回转参数判定方法、装置及作业机械 | |
CN113336096A (zh) | 起重机械状态检测方法、装置、电子设备及存储介质 | |
JP3308685B2 (ja) | 物体の衝突シミュレーション方法とその装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |