[发明专利]一种调整水平装置的方法

摘要

本发明公开了一种调整水平装置的方法，包括支撑平面、执行机构、控制单元；所述执行机构和所述控制单元分别位于所述支撑平面下部，所述执行机构包括固定支撑脚、两个剪式千斤顶驱动装置；采用PID闭环控制算法，将倾角传感器获得的量作为嵌入式控制器驱动执行机构的反馈，快速精确的调整水平，将剪式千斤顶作为执行机构，由步进电机经减速箱驱动剪式千斤顶的丝杆转动以调整支撑脚升降。本发明装置和方法具有调整速度快、调整精度高和承重性好的特点，其结构简单紧凑、稳定性高、具有广泛的实用性。

主权项

一种调整水平装置的方法，该调整水平装置包括支撑平面(9)、执行机构、控制单元(7)；所述执行机构和所述控制单元(7)均位于所述支撑平面(9)下部；所述执行机构包括固定支撑脚(6)、两个剪式千斤顶驱动装置；所述固定支撑脚(6)、所述两个剪式千斤顶驱动装置分别位于所述支撑平面(9)下部一个三角形的三个顶点处；所述控制单元(7)位于所述固定支撑脚(6)所在顶点朝向对边中垂线的垂足处；所述剪式千斤顶驱动装置包括剪式千斤顶(2)、减速箱(4)、步进电机(3)、步进电机驱动器(5)；所述剪式千斤顶(2)中段的丝杆(1)连接所述减速箱(4)，所述减速箱(4)固定连接所述步进电机(3)，所述步进电机(3)与所述步进电机驱动器(5)电连接，所述步进电机驱动器(5)固定于所述支撑平面(9)的下表面；所述控制单元(7)包括倾角传感器、嵌入式控制器；所述倾角传感器和所述嵌入式控制器中的其中一个接口连接；其特征在于：水平调整装置在控制中的具体步骤为：步骤1：嵌入式控制器硬件初始化；步骤2：嵌入式MCU对倾角传感器进行滤波，获取当前倾斜角度；步骤3：嵌入式MCU根据倾角传感器的输出判断当前工作平面是否水平；步骤4：如果水平则终止，如果不水平，则根据PID算法设定两个步进电机的驱动脉冲频率；步骤5：根据对剪式千斤顶的建模分析得出的调平算法调整策略设置调整方向和调节距离；步骤6：嵌入式MCU驱动步进电机执行调整；步骤7：跳转至步骤3；所述步骤2中对倾角传感器进行滤波,其中一阶滤波采用迭代阻尼滤波算法，二阶滤波采用中间值平均滤波算法；所述迭代阻尼滤波算法的步骤为：首先设置一个初始化阻尼，根据更新间隔和和上一次采样的结果计算出新的阻尼值，其输出值＝本次采样值+阻尼值*(上次采样值‑本次采样值)；所述步骤4、所述步骤5的具体过程为：经滤波后的值为稳定的值，经嵌入式MCU判断若不水平，则根据该值计算调平该倾斜角所需脉冲当量个数，此处用PID算法控制，根据倾角传感器采集到的数据计算离目标点的距离，根据距离计算所需步进电机脉冲个数，根据距离目标点的远近设置速度信号的输出频率，如果实际点距离目标点较远，步进电机驱动脉冲频率比较高，如果实际点距离目标点较近，步进电机驱动脉冲频率会比较低；再依据调平算法控制策略设置步进电机转动方向和驱动脉冲个数，最后驱动步进电机执行调整方案。