具体实施方式

为使本发明的目的、技术方案和优点更加清楚，下面将对本发明的技术方案进行详细的描述。显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动的前提下所得到的所有其它实施方式，都属于本发明所保护的范围。

在本发明的描述中，需要理解的是，术语“上”、“下”、“前”、“后”、“左”、“右”、“顶”、“底”、“内”、“外”、“中心”、“纵向”、“横向”、“竖直”、“水平”等指示的方位或位置关系为基于附图所示的方位或位置关系，仅是为了便于描述本发明和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本发明的限制。

需要说明的是，在本发明的描述中，术语“第一”、“第二”等仅用于描述目的，而不能理解为指示或暗示相对重要性或顺序。此外，在本发明的描述中，除非另有说明，“多个”的含义是指至少两个。

实施例1

如图1至图5所示，本实施例提供了一种起重机吊钩/吊物旋角检测系统，包括标志物、角度检测仪；所述角度检测仪包括图像采集装置及控制器；

所述标志物用于水平安装于吊钩的上表面，且所述标志物上表面同一圆周上设置有N个光源，且N≥3；

图像采集装置用于采集实时标志物图像并发送至控制器，其垂直向下安装在起重机小车上，且吊钩静止时标志物位于图像采集装置的视野中心；

控制器包括图像预处理模块、位置向量获取模块、自旋角度计算模块；

所述图像预处理模块用于对实时标志物图像进行预处理，建立标志物图像直角坐标系，获取每个光源光斑的实时圆心坐标，同时求取所有光源光斑的实时圆心坐标的平均值A_i；

所述位置向量获取模块用于基于三点共圆的方法求取标志物上N个光源的共圆实时圆心坐标D_i，得到实时位置向量还用于获取预设的起始位置向量

所述自旋角度计算模块用于基于实时位置向量和起始位置向量得到自旋角度α为：

优选地，所述标志物上N个光源中相邻光源之间的夹角为30°～100°，且光源为不可见光波段灯，图像采集装置前端设置有与光源波段对应的窄带滤光片。

更具体地，如图2所示，标志物包括标志物外壳、安装于标志物外壳内的电源、安装于标志物外壳上的电源开关1、电源指示灯2、光源4、第一水平仪5和排风扇7构成，排风扇、光源、电源指示灯均与电源电连接，光源开关用于控制电源回路的通断，排风扇用于标志物的散热。本实施例中，标志物外壳3上表面在半径为R＝40mm的同一圆周上开4个孔，如图3所示，用于安装光源4，两孔夹角从左至右分别为45°、90°和45°，光源优选940nm波段红外灯，采用4节1.5V电池供电，标志物外壳3优选为不锈钢或铝合金材质，标志物外壳3上设置有用于安装的固定螺栓孔6。

图像采集装置包括采集装置外壳8、滤光片9、镜头10、工业相机11、第二水平仪13、电源模块15，工业相机11、镜头10、滤光片9从上至下依次设置，控制器14集成于采集装置外壳8内，通过支撑脚12固定；工业相机11、控制器14均与电源模块电连接；采集装置外壳8底部为透明玻璃17。本实施例中滤光片9为与光源波段对应的940nm窄带滤光片。

使用该起重机吊钩/吊物摆角检测系统时，需先设定初始位置向量具体过程如下：

A1：获取起始标志物图像(即静置状态下的标志物图像)。

A2：对起始标志物图像进行预处理，建立标志物图像直角坐标系，获取每个光源光斑的起始圆心坐标。具体包括：

A21：对起始标志物图像进行降噪处理：选取十字交叉型结构元，对起始标志物图像进行形态学处理的开运算，去除起始标志物图像光源光斑中亮度较高的细小区域(面积小于预设值的区域)；

A22：采用边缘检测算法处理降噪后的起始标志物图像，获取每个光源对应的光源光斑轮廓；

A23：采用连通域函数对每个光源光斑轮廓进行处理，得到每个光源光斑的圆心坐标d_i(x_i,y_i)(i＝1,2,…,N)。

A3：求取所有光源光斑的起始圆心坐标的平均值A₀：

A4：并基于三点共圆的方法求取标志物上N个光源的共圆起始圆心坐标D₀，得到起始位置向量具体包括：

基于三点共圆的方法，N个光源三点共圆的圆心共个，求取个圆心坐标D′_j的平均值得到共圆起始圆心坐标D₀：

然后基于共圆起始圆心坐标D₀和起始圆心坐标的平均值A₀得到起始位置向量

然后获取实时标志物图像(运动过程中的标志物图像)，采用上述同样的方法得到实时位置向量

然后基于实时位置向量和起始位置向量得到自旋角度α为：

具体实施时，为了保证起始位置向量的精度，可采用多次测量求平均值的方式，具体包括：获取n帧起始标志物图像，采用上述方法求取n帧起始标志物图像的A₀和D₀，采用求平均值的方法得到n个A₀和D₀的平均值和进而得到起始位置向量

实施例2

如图6所示，本实施例提供了一种起重机吊钩/吊物旋角检测方法，包括：

S1：获取实时标志物图像；其中，标志物水平安装于吊钩的上表面，且在标志物的上表面同一圆周上设置有N个光源，且N≥3；实时标志物图像通过设置于标志物上方的图像采集装置采集得到；

S2：对实时标志物图像进行预处理，建立标志物图像直角坐标系，获取每个光源光斑的实时圆心坐标，求取所有光源光斑的实时圆心坐标的平均值A_i；并基于三点共圆的方法求取标志物上N个光源的共圆实时圆心坐标D_i，得到实时位置向量

S3：获取预设的起始位置向量

S4：基于实时位置向量和起始位置向量得到自旋角度α为：

本方案首先通过在标志物上设置多个光源，求取所有光源光斑的圆心坐标并取平均值，然后通过三点共圆的原理求取共圆的圆心，进而得到实时位置向量；然后基于实时位置向量和预设的初始位置向量得到自旋角度。通过三点共圆求取圆心的方法得到圆心坐标，相对于单个光源确定坐标的方式，减小了误差，提高了摆角的计算精度。

实施例3

如图7所示，本实施例提供了一种起重机吊钩/吊物旋角误差消除系统，其与实施例1的区别仅在于控制器还包括旋角消除模块，所述旋角消除模块用于获取当前自旋角度α和共圆实时圆心坐标D_i(x_w,y_w)；

获取实时起重机吊钩/吊物自旋中心在以共圆实时圆心D_i为原点的直角坐标系下的坐标O_i＝O₀(x,y)；其中O₀(x,y)为标定的起始位置时起重机吊钩/吊物自旋中心在以共圆起始圆心D₀为原点的直角坐标系下的坐标；

消除自旋角度后的理想位置下起重机吊钩/吊物自旋中心坐标O′_i(x’_B,y’_B)为：

用D′_i表示消除自旋角度后的理想位置下共圆圆心坐标，则在以共圆实时圆心D_i′为原点的直角坐标系下存在：

在标志物图像直角坐标系下，求取起始位置向量与标志物图像直角坐标系的水平坐标轴的夹角β，消除自旋角度后的理想位置下共圆圆心坐标D′_i(x’_w,y’_w)为：

图9所示为起重机运动过程中，采集标志物图像示意图。下面结合图9对消除自旋角的原料进行说明。

首先，起始位置时，D₀为共圆起始圆心，O₀为起始位置起重机吊钩/吊物自旋中心，以D₀为原点，标志物所在半圆周直径的中垂线为x轴，半圆周直径为y轴(所在方向)，人工标定出起重机吊钩/吊物自旋中心的坐标O₀(x,y)。

D_i为共圆实时圆心，O_i为实时起重机吊钩/吊物自旋中心，以D_i为原点，标志物所在半圆周直径的中垂线为x轴，半圆周直径为y轴(所在方向)，则实时起重机吊钩/吊物自旋中心O_i的坐标与O₀(x,y)数值相同，即O_i＝O₀(x,y)。

以实时起重机吊钩/吊物自旋中心O_i为中心，将标志物旋转角度α，得到的D′_i为消除自旋角度后的理想位置下共圆圆心；以共圆实时圆心D_i为中心，将标志物旋转角度α，得到的O′_i为消除自旋角度后的理想位置下起重机吊钩/吊物自旋中心。因此，可得到

消除自旋角度后的理想位置下共圆圆心坐标D′_i(x’_w,y’_w)计算过程如下：O_i＝O₀(x,y)已知，旋转角度α已知，即可求得O′_i(x’_B,y’_B)；D_i已知，且进而可求得消除自旋角度后的理想位置下共圆圆心坐标D′_i(x’_w,y’_w)。

实施例4

如图8所示，本实施例提供了一种起重机吊钩/吊物旋角误差消除方法，旋角误差消除方法即为求解出直角坐标系下消除自旋角度后的理想位置下共圆圆心坐标，包括：

S1：获取实时标志物图像；其中，标志物水平安装于吊钩的上表面，且在标志物的上表面同一圆周上设置有N个光源，且N≥3；实时标志物图像通过设置于标志物上方的图像采集装置采集得到；

S2：对实时标志物图像进行预处理，建立标志物图像坐标系，获取每个光源光斑的实时圆心坐标，求取所有光源光斑的实时圆心坐标的平均值A_i；并基于三点共圆的方法求取标志物上N个光源的共圆实时圆心坐标D_i(x_w,y_w)，得到实时位置向量

S3：获取预设的起始位置向量

S4：基于实时位置向量和起始位置向量得到自旋角度α为：

S5：获取实时起重机吊钩/吊物自旋中心在以共圆实时圆心D_i为原点的直角坐标系下的坐标O_i＝O₀(x,y)；其中O₀(x,y)为标定的起始位置时起重机吊钩/吊物自旋中心在以共圆起始圆心D₀为原点的直角坐标系下的坐标；

S6：消除自旋角度后的理想位置下起重机吊钩/吊物自旋中心坐标O′_i(x’_B,y’_B)为：

S7：用D′_i表示消除自旋角度后的理想位置下共圆圆心坐标，则在以共圆实时圆心D_i′为原点的直角坐标系下存在：

S8：在标志物图像直角坐标系下，求取起始位置向量与标志物图像直角坐标系的水平坐标轴的夹角β，消除自旋角度后的理想位置下共圆圆心坐标D′_i(x’_w,y’_w)为：

为进一步理解本发明的技术方案，下面结合试验作进一步说明。

搭建3m×2m×2m起重机模拟试验台，标志物水平安装在起重机吊钩的上表面，打开标志物电源开关，角度检测仪水平安装在起重机小车上，吊钩静止时标志物位于所采集实时图像的视野中心。

将标志物安放在旋转平台非圆心处，利用旋转平台的自转，来模拟实际标志物的自旋过程。在起重机吊钩/吊物没有摆动，且没有加消除自旋干扰的情况下，旋转180°后，摆角检测结果如图10(a)所示；在加了消除自旋干扰的情况下，旋转180°后，摆角检测结果如图10(b)所示。

由理论分析可知，起重机吊钩/吊物没有摆动时，标志物绕自旋中心旋转180°，摆角应该基本为0°。如图10(b)所示中，检测获取的摆角从0°到180°旋转过程中，摆角由0°到0.18°；标志物旋转到180°稳定后，摆角也在0.08°左右，非常接近0°。与图10(a)对比可见，旋角消除效果非常好。

对比未加消除自旋和加了消除自旋对摆角检测的影响，加了消除自旋后，自旋对吊钩或者吊物的摆动的影响大大减小，提高了摆角检测精度。

可以理解的是，上述各实施例中相同或相似部分可以相互参考，在一些实施例中未详细说明的内容可以参见其他实施例中相同或相似的内容。

流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为，表示包括一个或更多个用于实现特定逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分，并且本发明的优选实施方式的范围包括另外的实现，其中可以不按所示出或讨论的顺序，包括根据所涉及的功能按基本同时的方式或按相反的顺序，来执行功能，这应被本发明的实施例所属技术领域的技术人员所理解。

尽管上面已经示出和描述了本发明的实施例，可以理解的是，上述实施例是示例性的，不能理解为对本发明的限制，本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。