[发明专利]自动化集装箱码头轨道吊吊具姿态检测方法、装置和系统

权利要求书

1.自动化集装箱码头轨道吊吊具姿态检测方法，其特征在于，包括：

获取陀螺仪的角速度数据；

获取加速度传感器的加速度数据；

基于所述角速度数据和所述加速度数据计算轨道吊吊具的旋转角度和倾斜角度；

基于所述旋转角度和所述倾斜角度判断轨道吊吊具的姿态，在姿态异常时发出提示信息；

基于所述旋转角度和所述倾斜角度判断轨道吊吊具的姿态，具体包括：

在所述旋转角度大于第一预设旋转角度，且倾斜角度大于预设倾斜角度时，所述轨道吊吊具发生单角倾斜；以及，

在所述旋转角度小于第二预设旋转角度，且倾斜角度大于所述预设倾斜角度时，所述轨道吊吊具发生单侧倾斜。

2.根据权利要求1所述的自动化集装箱码头轨道吊吊具姿态检测方法，其特征在于，所述方法还包括：

检测所述轨道吊吊具的状态；

在所述轨道吊吊具开始上升后的预设距离范围内，基于所述旋转角度和所述倾斜角度判断轨道吊吊具的姿态，并在姿态异常时发出提示信息。

3.自动化集装箱码头轨道吊吊具姿态检测装置，其特征在于，包括：

陀螺仪，安装于轨道吊吊具上，用于检测轨道吊吊具的角速度数据；

加速度传感器，安装于轨道吊吊具上，用于检测轨道吊吊具的加速度数据；

姿态判断器，用于获取并基于所述角速度数据和所述加速度数据计算轨道吊吊具的旋转角度和倾斜角度；以及，基于所述旋转角度和所述倾斜角度判断轨道吊吊具的姿态；

报警模块，用于在姿态异常时发出提示信息；

所述姿态判断器包括：

单角倾斜姿态判断单元，用于在所述旋转角度大于第一预设旋转角度，且倾斜角度大于预设倾斜角度时，判断所述轨道吊吊具发生单角倾斜；

单侧倾斜姿态判断单元，用于在所述旋转角度小于第二预设旋转角度，且倾斜角度大于所述预设倾斜角度时，判断所述轨道吊吊具发生单侧倾斜。

4.根据权利要求3所述的自动化集装箱码头轨道吊吊具姿态检测装置，其特征在于，所述装置还包括：

轨道吊吊具状态检测器，用于检测所述轨道吊吊具的状态；

姿态判断限定模块，用于限定所述姿态判断器在所述轨道吊吊具开始上升后的预设距离范围内工作。

5.自动化集装箱码头轨道吊吊具姿态检测系统，包括：

轨道吊吊具控制模块，用于控制轨道吊吊具；

其特征在于，还包括：

如权利要求3-4任一项所述的自动化集装箱码头轨道吊吊具姿态检测装置；所述提示信息发送给所述轨道吊吊具控制模块，以使得所述轨道吊吊具控制模块基于所述提示信息控制轨道吊吊具停止工作。