[发明专利]桅杆调垂控制方法及其装置

权利要求书

1.一种桅杆调垂控制方法，其特征在于，包括以下步骤；

接收调垂有效信号，检测当前桅杆角度值；

标定桅杆角度；标定第一方向X轴的桅杆角度，标定第二方向Y轴的桅杆角度；

根据所述当前桅杆角度值从预设的电流参数曲线中选取电流输出参数，并根据所述电流输出参数控制输出电流值，以调整桅杆角度，直至所述桅杆角度为零度；

所述根据所述电流输出参数控制输出电流值的步骤包括：X轴正方向动作标志位为1，在X轴正方向可以实现调节；X轴向输出电流等于X轴向桅杆的当前角度对应的曲线选择电流；当X轴正方向动作标志位为0，则不可以在X轴正方向实现调节；

计时循环检测桅杆角度；在第一时刻检测并保存桅杆的第一角度值，在第二时刻检测并保存所述桅杆的第二角度值；根据所述第一角度值与所述第二角度值是否相等，判断调垂功能是否正常；所述调垂功能异常，所述电流参数曲线上调，判断所述电流参数曲线上调是否有效；当所述电流参数曲线上调有效，执行计时循环检测步骤；

还包括延时检测，单次执行所述计时循环检测步骤后，执行所述延时检测；若所述第二角度值不等于所述第一角度值，执行所述第二角度值临时保存，且延时触发标志位为1，延时检测执行，计时标志为0；若所述第二角度值等于所述第一角度值，则电流自加标志为1，电流参数曲线上调，X轴的基础变量自加并保存，继续执行计时循环检测；若电流参数曲线上调有效，直至桅杆角度在X轴向上的角度为0度，保存X轴的电流参数曲线，电流自加标志位为0，延时触发标志位为0，延时触发成功标志为0，X轴向的调垂结束。

2.根据权利要求1所述的桅杆调垂控制方法，其特征在于，在所述桅杆角度从小于零度向趋近于零度的调整过程中，如果检测出所述桅杆角度出现正数，所述电流参数曲线下调；

在所述桅杆角度从大于零度向趋近于零度的调整过程中，如果检测出所述桅杆角度出现负数，所述电流参数曲线下调。

3.根据权利要求2所述的桅杆调垂控制方法，其特征在于，所述电流参数曲线下调时，每次调整量为10mA至20mA。

4.一种桅杆调垂控制装置，其特征在于，包括控制器、操作开关、倾角传感器、电控阀组、计时循环检测模块和延时模块，所述控制器分别与所述操作开关、所述倾角传感器和所述电控阀组连接；

所述操作开关用于向所述控制器发出调垂信号，所述倾角传感器用于检测桅杆角度，所述控制器根据所述倾角传感器检测的桅杆角度，从预设的电流参数曲线中选取电流输出参数、并根据所述电流输出参数控制所述电控阀组的输出电流值，所述电控阀组用于调整所述桅杆角度，直至所述桅杆角度为零度；

所述计时循环检测模块用于所述桅杆角度的计时循环检测，在第一时刻检测并保存桅杆的第一角度值，在第二时刻检测并保存所述桅杆的第二角度值；根据所述第一角度值与所述第二角度值是否相等，判断调垂功能是否正常；所述调垂功能异常，所述电流参数曲线上调，判断所述电流参数曲线上调是否有效；当所述电流参数曲线上调有效，执行计时循环检测步骤；

所述延时模块用于所述桅杆角度的延时检测；单次执行所述计时循环检测步骤后，执行所述延时检测；若所述第二角度值不等于所述第一角度值，执行所述第二角度值临时保存，且延时触发标志位为1，延时检测执行，计时标志为0；若所述第二角度值等于所述第一角度值，则电流自加标志为1，电流参数曲线上调，X轴的基础变量自加并保存，继续执行计时循环检测；若电流参数曲线上调有效，直至桅杆角度在X轴向上的角度为0度，保存X轴的电流参数曲线，电流自加标志位为0，延时触发标志位为0，延时触发成功标志为0，X轴向的调垂结束。