风速变送器探杆角度调整方法及风速变送器技术

本发明专利技术涉及一种风速变送器探杆角度调整方法及风速变送器，主要应用于暖通空调、能源管理系统、VAV（变风量）及风扇控制、炉通风控制等领域。本发明专利技术利用IMU惯性测量单元实时获取探杆X、Y、Z三个轴的重力加速度和角速度数据，结合传感器单元实时获取的风速数据，来调整探杆的角度，尽可能的保证探杆进风口与风向之间的夹角小于5度，相对于现有技术人工调整的方式，具备更高的精确度，更高的效率，使得风速变送器更加智能化。送器更加智能化。送器更加智能化。

【技术实现步骤摘要】
风速变送器探杆角度调整方法及风速变送器


[0001]本专利技术涉及一种风速变送器探杆角度调整方法及风速变送器，主要应用于暖通空调、能源管理系统、VAV（变风量）及风扇控制、炉通风控制等领域。

技术介绍

[0002]现如今，风速、风量仪表更多的出现在工业生产、日常生活等领域，它与国民经济、工业生产、科学研究和环境保护息息相关。随着工业自动化的飞速发展，人们对风速、风量的测量要求也日益提高。重复性好、线性好、可靠性高、安装维护简单的风速变送器是未来的发展趋势。
[0003]目前市面上应用比较广泛的是热式风速变送器，其基本原理是将一根很细的金属丝放在流体中，通电流加热金属丝，使其温度高于流体的温度，当流体沿垂直方向流过金属丝时，将带走金属丝的一部分热量，使金属丝温度下降，根据强迫对流热交换理论，从而导出金属丝散失的热量Q与流体的速度V之间的关系式。
[0004]热式风速变送器的测量准确性与稳定性取决于探头的正确安装与定位，只有当探头安装在层流的位置时，才能进行准确的测量，因此对探杆的安装深度和安装角度都有要求，理想的安装位置如下：探杆插入深度为管道直径的30%~50%；探头进风口与风向保持水平，最大偏移角度不大于5
°
。
[0005]目前市面上的绝大部分热式风速变送器，都需要安装人员不断调节探杆来满足此安装要求，使用较为不便。具体来说，大多数热式风速变送器的探杆杆身上都铭刻有标尺，安装人员通过测量管道直径来计算出探杆的插入深度，结合探杆标尺比较容易把握安装深度。而探头进风口与风向保持水平这一要求则较难实现，工厂每次进行风速标定时，变送器探头很难通过人工调整来保持相同的安装角度，这样容易给标定结果引入误差，造成变送器的一致性变差。相对应的，客户在安装过程中也需要不断的调整探头与风向的角度，甚至需要借用标准风量设备测量对比，来获得较好的测量结果，安装过程费时费力。

技术实现思路

[0006]本专利技术的目的是针对上述存在的问题，提供一种风速变送器探杆角度调整方法及风速变送器，以方便调整探杆与风向的角度。
[0007]为了达到上述目的，本专利技术通过以下技术方案来实现：一种风速变送器探杆角度调整方法，包括：S1、风速变送器探杆安装完成后，控制探杆绕其轴线旋转1周；S2、旋转过程中，实时采集探杆在X、Y、Z轴的重力加速度值和角速度值，以及采集该重力加速度值和角速度值时的风速值，并进行滤波；S3、每隔一定时间Δt针对当前状态下所得到的、滤波后的X、Y、Z轴的重力加速度值和角速度值进行姿态求解，并将两种姿态进行互补融合，得到探杆的多个第一横滚角；S4、记录最大风速值所对应X、Y、Z轴的重力加速度值和角速度值求解得到的横滚
角，作为第二横滚角；S5、控制探杆再次绕其轴线旋转，执行步骤S2、S3，得到至少一个第三横滚角，当第三横滚角与第二横滚角之差小于2倍T
offset
时，探杆停止旋转；
[0008]式中，t0为探杆绕其轴线旋转1周的用时，Δt为探杆旋转过程中，相邻两次姿态求解的间隔时间。
[0009]优选的，采用递推平均滤波法将连续取得的N个采样值看成一个队列，队列的长度固定为N，每次采集到的新数据放入队尾，并扔掉原来队首的数据，把队列中的N个数据进行算术平均运算，获得新的滤波结果，完成滤波。
[0010]优选的，采用以下公式计算，得到所述第一横滚角和第三横滚角，
[0011]式中，roll
（n+1）
为当前状态下的横滚角，roll
n
为前一状态下的横滚角，roll
acc
为通过三轴加速度计数据计算得到的当前状态下的横滚角，roll
gyro
为通过三轴陀螺仪数据计算得到的当前状态下的横滚角，K为系数，取值范围为0.5
‑
0.8，n为自然数，即一系列状态0、1、2、3...，当n=0时，为初始静止状态。
[0012]优选的，采用以下公式计算，得到初始静止状态下的横滚角roll0，
[0013]式中，a
y0
为初始静止状态下三轴加速度计输出的Y轴重力加速度，a
z0
为初始静止状态下三轴加速度计输出的Z轴重力加速度；采用以下公式计算，得到通过三轴加速度计数据解算的当前状态下的横滚角roll
acc
，
[0014]式中，a
yacc
为当前状态下三轴加速度计输出的Y轴重力加速度，a
zacc
为当前状态下三轴加速度计输出的Z轴重力加速度；采用以下公式计算，得到通过三轴陀螺仪数据解算的当前状态下的横滚角roll
gyro
，
[0015]式中，roll
g（n+1）
为通过三轴陀螺仪数据解算的当前状态下的横滚角roll
gyro
，roll
gn
为通过三轴陀螺仪数据解算的前一状态下的横滚角，Δroll为通过三轴陀螺仪数据解算的当前状态相对于前一状态的横滚角变化量，Δt为当前状态与前一状态的时间差，也是探杆旋转过程中，相邻两次姿态求解的间隔时间，n为自然数，当n=0时，为初始静止状态，roll
g0
为0。
[0016]优选的，步骤S1和步骤S5中，探杆的旋转方向和速度均相同。
[0017]一种风速变送器，包括变送器本体、安装于变送器本体上的探杆、驱动探杆绕其轴线旋转的电机、安装于探杆上的IMU惯性测量单元和传感器单元；变送器本体，具有分别与所述IMU惯性测量单元和传感器单元通信连接的MCU处理单元；所述MCU处理单元，一方面控制电机工作，驱动探杆绕其轴线至少旋转一周；另一方面在探杆旋转过程中，接收来自传感器单元和IMU惯性测量单元的信息并进行滤波处理，每隔一定时间Δt针对当前状态下所得到的、滤波后的X、Y、Z轴的重力加速度值和角速度值进行姿态求解，并将两种姿态进行互补融合，得到探杆的多个第一横滚角，并记录最大风速值所对应X、Y、Z轴的重力加速度值和角速度值求解得到的横滚角，作为第二横滚角；再一方面，控制电机工作，驱动探杆再次绕其轴线旋转，再次根据来自传感器单元和IMU惯性测量单元的信息得到至少一个第三横滚角，当第三横滚角与第二横滚角之差小于2倍T
offset
时，控制电机停止工作，探杆停止旋转；
[0018]式中，t0为探杆绕其轴线旋转1周的用时，Δt为探杆旋转过程中，相邻两次姿态求解的间隔时间；IMU惯性测量单元，与MCU处理单元通信连接，用于采集探杆在X、Y、Z轴的重力加速度值和角速度值，并将其传输至MCU处理单元；传感器单元，用于实时采集风速信息并将其传输至MCU处理单元；电机，一方面与MCU处理单元通信连接，另一方面与探杆相连以驱动探杆绕其轴线旋转。
[0019]优选的，所述MCU处理单元，还用于采用递推平均滤波法将连续取得的N个采样值看成一个队列，队列的长度固定为N，每次采集到的新数据放入队尾，并扔掉原来队首的数据，把队列本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种风速变送器探杆角度调整方法，其特征在于，包括：S1、风速变送器探杆安装完成后，控制探杆绕其轴线旋转1周；S2、旋转过程中，实时采集探杆在X、Y、Z轴的重力加速度值和角速度值，以及采集该重力加速度值和角速度值时的风速值，并进行滤波；S3、每隔一定时间Δt针对当前状态下所得到的、滤波后的X、Y、Z轴的重力加速度值和角速度值进行姿态求解，并将两种姿态进行互补融合，得到探杆的多个第一横滚角；S4、记录最大风速值所对应X、Y、Z轴的重力加速度值和角速度值求解得到的横滚角，作为第二横滚角；S5、控制探杆再次绕其轴线旋转，执行步骤S2、S3，得到至少一个第三横滚角，当第三横滚角与第二横滚角之差小于2倍T
offset
时，探杆停止旋转；式中，t0为探杆绕其轴线旋转1周的用时，Δt为探杆旋转过程中，相邻两次姿态求解的间隔时间。2.根据权利要求1所述的风速变送器探杆角度调整方法，其特征在于：采用递推平均滤波法将连续取得的N个采样值看成一个队列，队列的长度固定为N，每次采集到的新数据放入队尾，并扔掉原来队首的数据，把队列中的N个数据进行算术平均运算，获得新的滤波结果，完成滤波。3.根据权利要求1所述的风速变送器探杆角度调整方法，其特征在于：采用以下公式计算，得到所述第一横滚角和第三横滚角，式中，roll
（n+1）
为当前状态下的横滚角，roll
n
为前一状态下的横滚角，roll
acc
为通过三轴加速度计数据计算得到的当前状态下的横滚角，roll
gyro
为通过三轴陀螺仪数据计算得到的当前状态下的横滚角，K为系数，取值范围为0.5
‑
0.8，n为自然数。4.根据权利要求3所述的风速变送器探杆角度调整方法，其特征在于：采用以下公式计算，得到初始静止状态下的横滚角roll0，式中，a
y0
为初始静止状态下三轴加速度计输出的Y轴重力加速度，a
z0
为初始静止状态下三轴加速度计输出的Z轴重力加速度；采用以下公式计算，得到通过三轴加速度计数据解算的当前状态下的横滚角roll
acc
，式中，a
yacc
为当前状态下三轴加速度计输出的Y轴重力加速度，a
zacc
为当前状态下三轴加速度计输出的Z轴重力加速度；采用以下公式计算，得到通过三轴陀螺仪数据解算的当前状态下的横滚角roll
gyro
，式中，roll
g（n+1）
为通过三轴陀螺仪数据解算的当前状态下的横滚角roll
gyro
，roll
gn
为通过三轴陀螺仪数据解算的前一状态下的横滚角，Δroll为通过三轴陀螺仪数据解算的当前状态相对于前一状态的横滚角变化量，Δt为当前状态与前一状态的时间差，也是探杆旋转过程中，相邻两次姿态求解的间隔时间，n为自然数。5.根据权利要求1所述的风速变送器探杆角度调整方法，其特征在于：步骤S1和步骤S5
中，探杆的旋转方向和速度均相同。6.一种风速变送器，其特征在于：包括变送器本体、安装于变送器本体上的探杆、驱动探杆绕其轴线旋转的电机、安装于探杆上的IMU惯性测量单元和传感器单元；变送器本体，具有分别与所述IMU惯性测量单元和传感器单元通信连接的MC...

【专利技术属性】
技术研发人员：刘春涛，郭忠，侯志远，张东宇，廖辉，金玲珑，
申请(专利权)人：浙江力夫传感技术有限公司，
类型：发明
国别省市：