[发明专利]一种吊具的检测对准方法和装置

说明书

本申请提供一种吊具的检测对准方法和装置。该方法包括：检测第一对准设备的位置以及第二对准设备位置；当第一对准设备从初始位置下降到第一位置后悬停，根据此时第一对准设备和第二对准设备的位置，确定第一对准设备和第二对准设备是否对准；当第一对准设备和第二对准设备没有对准时，对准装置控制第一对准设备和第二对准设备精确对准。其中，在卸箱过程时，该第一对准设备为吊具，该第二对准设备为集装箱，在装箱过程时，该第一对准设备为吊具和集装箱的组合设备，该第二对准设备为标准装箱位置。本申请保证第一对准设备下降到第二对准设备周围时，第一对准设备和第二对准设备精确对准，完成装卸箱操作。

技术领域

本申请涉及起重设备技术领域，尤其涉及一种吊具的检测对准方法和装置。

背景技术

随着科技不断发展与更新，港口无人驾驶也逐渐兴盛。港口无人驾驶集卡在作业过程中需要和吊车共同配合作业。吊车可以为岸桥(也称桥吊)或轨道吊(也称龙门吊)。

集卡包含了牵引车和挂车，其在配合吊车作业过程中，需要精确检测吊车位置，以配合其吊具顺利完成装卸箱作业。作业前，通常因作业流程处于很高的初始位置或正在进行其他操作，吊车的吊具不在集卡感知范围之内。现有的检测方法是在吊具下来前依靠相机或激光雷达检测吊车上自有或加装的标志物，得到自车(即集卡)和吊车的相对位置。

现有技术受外部因素影响(如天气、设备维修、作业场所老化等)，吊具在下降过程中会偏离标准作业位置，导致吊具下来后可能因偏差过大无法完成装卸箱操作。

发明内容

本申请提供一种吊具的检测对准方法和装置，用以解决吊具在装卸箱作业过程中对位不精准问题，提高作业成功率。

第一方面，本申请提供一种吊具的检测对准方法，包括：

检测第一对准设备的位置以及第二对准设备的位置，其中，在卸箱过程中，所述第一对准设备为吊具，所述第二对准设备为集装箱，在装箱过程中，所述第一对准设备为吊具和集装箱的组合设备，所述第二对准设备为标准装箱位置，所述标准装箱位置用于放置集装箱；

当第一对准设备从初始位置下降到第一位置之后，根据所述第一对准设备的位置和所述第二对准设备的位置，确定所述第一对准设备和所述第二对准设备是否对准，所述第一位置与所述第二对准设备之间的高度小于所述初始位置与所述第一位置之间的高度；

当所述第一对准设备和所述第二对准设备没有对准时，根据所述第一对准设备的位置以及所述第二对准设备的位置，控制所述第一对准设备和所述第二对准设备对准。

在一种可行的方式中，所述检测所述第一对准设备的位置以及所述第二对准设备的位置，包括：

获取集卡顶部安装的雷达采集所述第一对准设备以及所述第二对准设备的点云数据，所述集卡包括牵引车和挂车，所述雷达安装在所述牵引车的顶部，所述第二对准设备位于在所述挂车上；

将所述点云数据从雷达所在坐标系转换至车前坐标系，所述车前坐标系为所述集卡所在坐标系；

根据所述雷达的安装位姿、所述第一对准设备的悬停高度和所述第二对准设备的安装位置，从坐标转换后的所述点云数据中确定所述第一对准设备和所述第二对准设备的感兴趣区域ROI；

计算所述ROI内的点云的法向量，并确定所述ROI内的点云中的各点的法向量与所述车前坐标系的X轴的夹角；

从所述ROI内的点云中去除所述夹角大于等于预设角度的点，得到所述ROI的第一点云集合；

使用RANSAC算法从所述ROI的第一点云集合中去除噪声点，得到所述ROI的第二点云集合；

根据所述第一对准设备的ROI的第二点云集合确定所述第一对准设备的位置，根据所述第二对准设备的ROI的第二点云集合确定所述第二对准设备的位置；