1.山区河流推移质运动姿态与输沙通量的监测方法,其特征在于,包括以下步骤:S1、获取推移质的三轴角速度数据、三轴加速度数据和三轴磁力计数据;
S2、利用三轴加速度数据和三轴磁力计数据对三轴角速度数据进行修正,并基于修正后的三轴角速度数据提取实时四元数,通过实时四元数解算推移质的姿态角;
S3、利用三轴加速度数据计算推移质的累积位移,使用累积位移和姿态角表示推移质的运动姿态;
S4、计算基于河道天然推移质的输沙通量和智能粒子获取的输沙通量,并基于河道天然推移质的输沙通量和智能粒子获取的输沙通量计算总输沙通量;
S4具体如下:
获取河道长度L和河道宽度W,计算移动颗粒总数N:(15)
其中,N为移动颗粒总数,通过采样器采集;nD表示单位河道长度的颗粒数;PD为颗粒对数升余弦分布函数,PD计算方式如下:(16)
(17)
其中,D为颗粒粒径分布曲线上的点;D50为颗粒粒径分布曲线上的中值粒径,颗粒粒径分布曲线可通过采样器取样筛分得到;为粒径对数升余弦分布函数的标准差;
nD与天然推移质输沙通量Qb,NG的关系如下:(18)
其中,V为颗粒体积,V=4π/3(D/2)2;us为平均推移质流速,通过智能粒子获取;
根据式(15)和式(18),计算河道天然推移质的输沙通量:(19)
其中,Qb,NG表示河道天然推移质的输沙通量;
智能粒子获取的输沙通量为:
(20)
其中,Qb,SR表示智能粒子获取的输沙通量;NSR表示河道中移动的智能粒子数量;VSR为智能粒子的体积;
基于河道天然推移质的输沙通量Qb,NG和智能粒子获取的输沙通量Qb,SR计算总输沙通量:(21)
其中,Qb表示总输沙通量。
2.根据权利要求1所述的山区河流推移质运动姿态与输沙通量的监测方法,其特征在于,所述S2,具体为:给四元数q0,q1,q2,q3赋值初始值[q0,q1,q2,q3]=[1,0,0,0];
在载体坐标系b下,利用三轴加速度数据和三轴磁力计数据对三轴角速度数据进行修正,具体计算方式如下:(1)
(2)
(3)
其中,gb为重力分量,gb=[0,0,1],Ab为三轴加速度数据,Ab=[Abx,Aby,Abz]T;eg为重力误差值;Mb为参考向量,Mb=[Mrawx,Mrawy,Mrawz]T;Wb为三轴磁力计数据,Wb=[Wbx,Wby,Wbz]T,eM为磁力误差值;e为总误差值;
利用总误差值对获取到的三轴角速度数据ωk进行修正,得到修正后的三轴角速度数据ωr,计算方式如下:(4)
其中,ωr为经过修正的三轴角速度数据,ωr=[ωrx,ωry,ωrz],ωrx,ωry,ωrz分别表示x,y,z轴的角速度数据;其中f表示采样频率,由人为设定;
使用修正后的三轴角速度数据ωr建立三轴角速度矩阵:(5)
其中,Ωb表示三轴角速度矩阵;
使用三轴角速度矩阵Ωb计算实时四元数,计算方式如下:(6)
(7)
其中,i、j、k为虚数单位向量并且互相正交;Q(t)表示第t次采样时的四元数表达式,采样间隔为0.0005秒;在初始时刻,将赋了初始值的q0,q1,q2,q3带入式(6)计算得到Q(1),再通过式(7)可计算得到Q(2),再返回式(6)计算Q(2)对应的实时四元数q0,q1,q2,q3,以次类推,可得到每个采样时刻t对应的实时四元数;
利用实时四元数构建旋转矩阵:
(8)
其中,是用于将载体坐标系b转换到地理坐标系n的旋转矩阵;
利用实时四元数解算推移质的姿态角,所述姿态角包括偏航角、俯仰角以及翻滚角,解算过程如下:(9)
(10)
(11)
其中,yaw为偏航角,pitch为俯仰角,roll为翻滚角;arctan为反正切函数,arcsin为反正弦函数。
3.根据权利要求2所述的山区河流推移质运动姿态与输沙通量的监测方法,其特征在于,所述S3具体为:利用三轴加速度数据与旋转矩阵分离重力加速度G,进而得到地理坐标系n下的三轴加速度数据,其计算方式为:(12)
其中,G为重力加速度,;
利用地理坐标系n下的三轴加速度数据An和加速度计的采样时间间隔计算三轴瞬时速度和三轴累积位移,计算方式如下:(13)
(14)
在地理坐标系n下,u[m]x表示m时刻推移质在x轴的瞬时速度,当m=1时,u[m-1]x=0;A[m]nx表示m时刻在x轴的加速度;S[m]x表示0-m时间段推移质在x轴上的累积位移;按照式(13)、式(14)的方式可计算出推移质在y轴、z轴上的累积位移。
4.山区河流推移质运动姿态与输沙通量的监测系统,用于实现权利要求1-3任一项所述的山区河流推移质运动姿态与输沙通量的监测方法,其特征在于,包括:数据采集模块,用于获取推移质的三轴角速度数据、三轴加速度数据和三轴磁力计数据;
运动姿态提取模块,用于利用三轴加速度数据和三轴磁力计数据对三轴角速度数据进行修正,并基于修正后的三轴角速度数据提取实时四元数,通过实时四元数解算推移质的姿态角,并且基于三轴加速度数据计算推移质的累积位移,使用累积位移和姿态角表示推移质的运动姿态;
输沙通量计算模块,用于计算基于河道天然推移质的输沙通量和智能粒子获取的输沙通量,并基于河道天然推移质的输沙通量和智能粒子获取的输沙通量计算总输沙通量。