1.一种拱坝混凝土缆机吊运轨迹预测方法,其特征在于:所述拱坝混凝土缆机吊运轨迹预测方法包括以下步骤:
1)构建空间坐标系,确定缆机的空间定位节点;所述缆机的空间定位节点包括小车的空间定位节点以及吊罐的空间定位节点;
2)使用传感器获取基于步骤1)中缆机的空间定位节点的实时位置信息,所述实时位置信息包括小车以及吊罐在空间坐标系下的坐标;
3)使用卡尔曼滤波对步骤2)中获取的缆机的空间定位节点的实时位置信息进行滤波降噪预处理;
4)对步骤3)得到的预处理后缆机的空间定位节点的实时位置信息进行计算,获取缆机的时序运动状态参数,所述缆机的时序运动参数包括缆机小车的水平和垂直运动速度及加速度、吊罐瞬时摆角、吊罐角速度和角加速度;
5)采用拉格朗日力学方法构建缆机小车-起升绳-吊罐系统动力学模型;
6)基于步骤5)得到的缆机小车-起升绳-吊罐系统动力学模型,将步骤4)获取得到的缆机的时序运动状态参数作为输入参数预测缆机吊罐的摆角并得到吊罐运动轨迹。
2.根据权利要求1所述的拱坝混凝土缆机吊运轨迹预测方法,其特征在于:所述步骤1)的具体实现方式是:获取缆机小车和吊罐的坐标及在YOX平面上的投影坐标:以顺河向为x轴,以横河向为y轴,垂直向为z轴构建空间坐标系构建空间坐标系,所述缆机小车的坐标是A(xA,yA,zA);所述缆机吊罐的坐标是B(xB,yB,zB);所述缆机小车在yox平面上的投影坐标是A′(xA,yA,zB);所述缆机吊罐在y轴和x轴上的投影坐标分别是Bx(xB,0,zB)以及By(0,yB,zB);
其中:
A点表示小车;
B点表示吊罐;
A′点表示A点向yox平面的投影点;
Bx点表示B点向x轴的投影点;
By点表示B点向y轴的投影点;
xA表示A点在x轴上的位置;
yA表示A点在y轴上的位置;
zA表示A点在z轴上的位置;
xB表示B点在x轴上的位置;
yB表示B点在y轴上的位置;
zB表示B点在z轴上的位置。
3.根据权利要求2所述的拱坝混凝土缆机吊运轨迹预测方法,其特征在于:所述步骤2)中缆机的空间定位节点的实时位置信息的具体获取方式是:小车和吊罐的坐标分别为:
小车和吊罐的速度分别为:
其中:
m是吊罐质量;
M是小车质量;
l是起升绳的长度;
为起升绳绳长变化率;
θx是缆机吊罐在摆动时起升绳与x轴的夹角;
θy是缆机吊罐在摆动时起升绳与y轴的夹角;
xM中表示小车受到的牵引力FM受力方向的坐标,在x轴上的投影长度;
yM中表示小车受到的牵引力FM受力方向的坐标,在y轴上的投影长度;
zM中表示小车受到的牵引力FM受力方向的坐标,在z轴上的投影长度;
xm中表示起升绳受到的拉力Fl受力方向的坐标,在x轴上的投影长度;
ym中表示起升绳受到的拉力Fl受力方向的坐标,在y轴上的投影长度;
zm中表示起升绳受到的拉力Fl受力方向的坐标,在z轴上的投影长度;
vMx是小车沿x轴的速度;
vMy是小车沿y轴的速度;
vMz是小车沿z轴的速度;
vmx是吊罐沿x轴的速度;
vmy吊罐沿y轴的速度;
vmz是吊罐沿z轴的速度;
是吊罐沿x轴的速度;
是吊罐沿z轴的速度。
4.根据权利要求3所述的拱坝混凝土缆机吊运轨迹预测方法,其特征在于:所述步骤4)中吊罐瞬时摆角包括缆机吊罐在摆动时起升绳与x轴的夹角θx以及缆机吊罐在摆动时起升绳与y轴的夹角θy;
所述缆机吊罐在摆动时起升绳与x轴的夹角θx的计算方式是:所述缆机吊罐在摆动时起升绳与y轴的夹角θy的表达式是:其中:
表示从A点到Bx点的向量;
表示从A点到A′点的向量;
表示从A点到B点的向量;
表示向量的模;
表示向量的模;
表示向量的模。
5.根据权利要求3所述的拱坝混凝土缆机吊运轨迹预测方法,其特征在于:所述步骤4)中缆机小车的水平和垂直运动速度及加速度的计算方式是:所述缆机小车沿x轴方向的速度的表达式是:其中:
是缆机小车在第i+1个采样时刻沿x轴方向的运动速度;
为缆机小车在第i个采样时刻沿x轴方向的运动速度;
Δt是采样时间间隔;
是缆机小车在第i个采样时刻沿x轴方向的加速度,所述的表达式是:其中:
是缆机小车在第i个采样时刻到i+1个采样时刻之间沿x轴方向的位移;
所述缆机小车沿z轴方向的速度的表达式是:其中:
是缆机小车在第i+1个采样时刻沿z轴方向的运动速度;
为缆机小车在第i个采样时刻沿z轴方向的运动速度;
Δt是采样时间间隔;
是缆机小车在第i个采样时刻沿z轴方向的加速度,所述的表达式是:其中:
是缆机小车在第i个采样时刻到i+1个采样时刻之间沿z轴方向的位移。
6.根据权利要求3所述的拱坝混凝土缆机吊运轨迹预测方法,其特征在于:所述步骤4)中缆机吊罐的角速度及角加速度的计算方式是:所述缆机吊罐绕x轴方向的角速度的表达式是:其中:
是缆机吊罐在第i+1个采样时刻绕x轴方向角速度;
是缆机吊罐在第i个采样时刻绕x轴方向角速度;
Δt是采样时间间隔;
第i个采样时刻缆机吊罐绕x轴方向的转动角加速度;所述的表达式是:其中:
θxi为第i个采样时刻到i+1个采样时刻之间的缆机吊罐绕x轴转动的角度;
所述缆机吊罐绕y轴方向的角速度的表达式是:其中:
是缆机吊罐在第i+1个采样时刻绕y轴方向角速度;
是缆机吊罐在第i个采样时刻绕y轴方向角速度;
Δt是采样时间间隔;
第i个采样时刻缆机吊罐绕y轴方向的转动角加速度;所述的表达式是:其中:
θyi为第i个采样时刻到i+1个采样时刻之间的缆机吊罐绕y轴转动的角度。
7.根据权利要求3所述的拱坝混凝土缆机吊运轨迹预测方法,其特征在于:所述步骤5)中缆机小车-起升绳-吊罐系统动力学模型的构建方法是:获取拉格朗日方程,所述拉格朗日方程的一般形式如下:式中:L为拉格朗日算子,T为系统动能,V为系统势能,q为变量,i为变量编号,fi为广义外力;
基于拉格朗日方程建立缆机小车-起升绳-吊罐系统动力学模型:缆机小车-起升绳-吊罐系统动力学模型为:其中:
m是吊罐质量;
M是小车质量;
l是起升绳的长度;
为起升绳绳长变化率;
θx是缆机吊罐在摆动时起升绳与x轴的夹角;θy是缆机吊罐在摆动时起升绳与y轴的夹角;是吊罐沿x轴的速度;
是吊罐沿z轴的速度;
g为重力加速度;
分别为小车沿x轴方向和z轴方向的加速度;为绕x轴旋转的角速度;
为绕x轴旋转的角加速度。