[发明专利]工业支架车自动对中的检测控制装置及方法

说明书

本申请揭示了一种工业支架车自动对中的检测控制装置及方法，该检测装置包括位置检测设备和主控单元，其中：位置检测设备包括间隔120°安装在对接环上的三个测距仪、间隔180°安装在对接环上的两个相机，以及圆柱型载荷对接端面上间隔180°布置的两个目标靶；主控单元根据三个测距仪测量的距离以及目标靶的位置，计算圆柱型载荷的方位角、俯仰角以及滚转角；根据方位角、俯仰角以及滚动角控制对应的支架进行升降、水平移动以及轴向转动。本申请实现了圆柱型载荷的自动调整对中，姿态控制精度高，调整周期较短的效果。

技术领域

本发明属于工业支架车控制设备自动姿态控制领域，涉及一种工业支架车自动对中的检测控制装置及方法。

背景技术

对接环在空间位置上保持不动，前、中、后三辆支架车上承载着圆柱型载荷，每辆支架车在空间位置上可在三个维度自由调整位置，从而使圆柱型载荷与对接环对齐，即完成对中过程。对中过程是工业对中设备完成作业的准备工作，也是整个作业过程中最费时费力的环节。支架车的姿态调整往往是根据经验人为调整三个维度对应的丝杠的运动位置，从而改变整个圆柱型载荷的姿态。

支架车的三个维度运动，分别为上下举升、左右横移、轴向滚转。圆柱型载荷在单一维度的姿态调整时，由于位置耦合的原因往往难以实现预定的效果。通过手动机械传动的方式调整丝杠位置，需先后调整前、中、后三个支架车，效率低下，姿态调整过程易反复，且需借助其他空间位置测量仪器检验对中效果。

支架车相对其他装备来说，可操作性差、自动化程度低、姿态控制精度差，不具备较为良好的人机交互功能。

发明内容

为了解决相关技术中对支架车所承载的载荷对中调整时，可操作性差、自动化程度低、姿态控制精度差的问题，本申请提供了一种工业支架车自动对中的检测控制装置及方法，可以通过对支架车的自动调整，以实现支架车所承载的载荷的对中。具体技术方案如下：

第一方面，本申请提供了一种工业支架车自动对中的检测控制装置，所述检测控制装置控制三个支架车共同承载的一圆柱型载荷的对接端面与对接环对中，所述对接环竖向放置，所述检测控制装置包括位置检测设备和主控单元，其中：所述位置检测设备包括间隔120°安装在所述对接环上的三个测距仪、间隔180°安装在所述对接环上的两个相机，以及所述圆柱型载荷对接端面上间隔180°布置的两个目标靶；每个测距仪用于测量所述对接环与所述圆柱型载荷对接端面之间的距离，两个相机分别拍摄获取两个目标靶的位置；所述主控单元根据所述三个测距仪测量的距离，计算所述圆柱型载荷对接端面与竖直面之间形成的方位角，以及与水平面之间形成的俯仰角；所述主控单元还根据拍摄获取的两个目标靶的位置，计算所述圆柱型载荷轴向的滚转角；所述主控单元根据所述方位角控制对应的支架进行水平运动，根据所述俯仰角控制对应的支架进行升降移动，根据所述滚转角控制对应的支架进行轴向转动。

可选的，所述测距仪为激光测距仪，所述激光测距仪向所述圆柱型载荷对接端面发射激光，并接收从所述对接端面发射回的激光，根据激光的发射时刻和接收时刻，计算所述圆柱型载荷对接端面与所述激光测距仪之间的距离。

可选的，所述检测控制装置还包括与每辆支架车对应的控制器，所述控制器与对应的支架车的电机驱动器电性连接，所述控制器通过向所述电机驱动器发送驱动指令，以控制对应支架车的升降运动、水平移动以及轴向转动。

可选的，每辆支架车的所述控制器均与所述主控单元通过无线通信方式进行通信连接，所述主控单元通过无线通信网络向各个所述控制器下发移动控制指令，所述控制器将所述移动控制指令转化为可被对应的电机驱动器识别的驱动指令，所述电机驱动器根据所述驱动指令驱动对应支架车执行相应动作。

可选的，所述主控单元根据所述方位角、所述俯仰角以及所述滚转角进行解耦计算，得到三个支架车在三个自由度上的移动控制指令，将所述移动控制指令分别对应发送给三个支架车的控制器，所述三个自由度包括竖直面、水平面以及轴向转动面。