[go: up one dir, main page]

CN114441807B - A wiring method and system - Google Patents

A wiring method and system Download PDF

Info

Publication number
CN114441807B
CN114441807B CN202110832521.3A CN202110832521A CN114441807B CN 114441807 B CN114441807 B CN 114441807B CN 202110832521 A CN202110832521 A CN 202110832521A CN 114441807 B CN114441807 B CN 114441807B
Authority
CN
China
Prior art keywords
controller
target interface
contact force
connector
target
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202110832521.3A
Other languages
Chinese (zh)
Other versions
CN114441807A (en
Inventor
毛欢
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Honor Device Co Ltd
Original Assignee
Honor Device Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Honor Device Co Ltd filed Critical Honor Device Co Ltd
Priority to CN202110832521.3A priority Critical patent/CN114441807B/en
Publication of CN114441807A publication Critical patent/CN114441807A/en
Application granted granted Critical
Publication of CN114441807B publication Critical patent/CN114441807B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01RMEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
    • G01R1/00Details of instruments or arrangements of the types included in groups G01R5/00 - G01R13/00 and G01R31/00
    • G01R1/02General constructional details
    • G01R1/04Housings; Supporting members; Arrangements of terminals
    • G01R1/0408Test fixtures or contact fields; Connectors or connecting adaptors; Test clips; Test sockets
    • G01R1/0416Connectors, terminals
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/02Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/04Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1694Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1694Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • B25J9/1697Vision controlled systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01RMEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
    • G01R1/00Details of instruments or arrangements of the types included in groups G01R5/00 - G01R13/00 and G01R31/00
    • G01R1/02General constructional details
    • G01R1/04Housings; Supporting members; Arrangements of terminals
    • G01R1/0408Test fixtures or contact fields; Connectors or connecting adaptors; Test clips; Test sockets
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Manipulator (AREA)

Abstract

本申请提供一种接线方法及系统。所述接线系统包括控制器、机械臂以及设置在机械臂末端的工业相机、连接头和传感器。所述方法包括:控制器获取工业相机采集的目标接口的位置信息;控制器根据位置信息,控制机械臂,使连接头与目标接口接触;控制器获取传感器采集的连接头与目标接口之间的接触力;控制器根据接触力,调整机械臂位姿,以减小接触力;控制器在接触力小于偏差阈值时,控制机械臂,使连接头插入到目标接口中。由此可见,本申请提供的技术方案中,控制器根据工业相机采集的目标接口的位置信息,以及传感器采集的接触力,调整机械臂的位姿,可以快速实现连接头与目标接口的高精度对接,从而提高电子设备调试效率。

Figure 202110832521

The present application provides a wiring method and system. The wiring system includes a controller, a robot arm, and an industrial camera, a connector and a sensor arranged at the end of the robot arm. The method includes: the controller acquires the position information of the target interface collected by the industrial camera; the controller controls the mechanical arm according to the position information to make the connector contact the target interface; the controller acquires the distance between the connector and the target interface collected by the sensor Contact force; the controller adjusts the pose of the robotic arm according to the contact force to reduce the contact force; when the contact force is less than the deviation threshold, the controller controls the robotic arm to insert the connector into the target interface. It can be seen that in the technical solution provided by this application, the controller adjusts the position and posture of the mechanical arm according to the position information of the target interface collected by the industrial camera and the contact force collected by the sensor, which can quickly realize the high precision of the connecting head and the target interface Docking, thereby improving the debugging efficiency of electronic equipment.

Figure 202110832521

Description

一种接线方法及系统A kind of wiring method and system

技术领域technical field

本申请涉及设备调试技术领域,具体涉及一种接线方法及系统。The present application relates to the technical field of equipment debugging, in particular to a wiring method and system.

背景技术Background technique

电子设备在出厂前或者维修时需要进行性能调试,以确保电子设备的各项功能完好,使用户可以正常使用电子设备。调试人员在对电子设备调试时,为了获取调试数据,需要使用调试数据线与电子设备建立连接。Electronic equipment needs performance debugging before leaving the factory or during maintenance to ensure that all functions of the electronic equipment are in good condition, so that users can use the electronic equipment normally. When debugging an electronic device, a debugger needs to use a debugging data cable to establish a connection with the electronic device in order to obtain debugging data.

对于电子设备的天线射频传导、电池充电等不同的性能调试,调试人员需要将不同的调试数据线与电子设备上对应的接口连接。例如,在对电子设备的天线进行射频传导测试时,调试人员需要将天线调试数据线与电子设备的天线接口连接,在对电子设备进行充电调试时,调试人员需要将充电调试数据线与电子设备的充电接口连接。For different performance debugging such as antenna radio frequency conduction and battery charging of electronic equipment, debugging personnel need to connect different debugging data lines to corresponding interfaces on the electronic equipment. For example, when conducting radio frequency conduction tests on the antenna of an electronic device, the debugger needs to connect the antenna debugging data cable to the antenna interface of the electronic device; when charging and debugging the electronic device, the debugger needs to connect the charging and debugging data cable to the connected to the charging port.

通常,调试人员在对电子设备进行性能调试时,首先需要将待测电子设备放置于操作台,然后根据性能调试的需求选择调试数据线,最后通过肉眼观察电子设备,找到对应的接口,手动将调试数据线插入接口,这一过程需要消耗较长的时间,导致调试效率很低。在大量的电子设备进行性能调试的情况下,如果每一台电子设备都通过调试人员人工对不同接口进行接线,将会大幅降低整个生产线或者维修线的调试效率,影响电子设备的交付速度。Usually, when debugging the performance of an electronic device, the debugger first needs to place the electronic device to be tested on the operating table, then select the debugging data line according to the performance debugging requirements, and finally observe the electronic device with the naked eye, find the corresponding interface, and manually connect the It takes a long time to insert the debugging data cable into the interface, resulting in low debugging efficiency. In the case of performance debugging of a large number of electronic devices, if each electronic device is manually wired to different interfaces by debuggers, it will greatly reduce the debugging efficiency of the entire production line or maintenance line, and affect the delivery speed of electronic devices.

发明内容Contents of the invention

本申请提供了一种接线方法及系统,以解决人工接线需要消耗较长的时间,从而导致电子设备调试效率低的问题。The present application provides a wiring method and system to solve the problem that manual wiring takes a long time, resulting in low efficiency of electronic equipment debugging.

第一方面,本申请提供了一种接线方法,该方法应用于接线系统,接线系统包括控制器、机械臂、工业相机、连接头和传感器,工业相机、连接头和传感器设置在机械臂的末端,控制器与机械臂、工业相机、连接头和传感器耦合;该方法包括:控制器获取工业相机采集的目标接口的位置信息;控制器根据位置信息,控制机械臂,使连接头与目标接口接触;控制器获取传感器采集的连接头与目标接口之间的接触力;控制器根据接触力,调整机械臂位姿,以减小接触力;控制器在接触力小于偏差阈值时,控制机械臂,使连接头插入到目标接口中。In the first aspect, the present application provides a wiring method, which is applied to a wiring system. The wiring system includes a controller, a robotic arm, an industrial camera, a connector, and a sensor. The industrial camera, the connector, and the sensor are arranged at the end of the robotic arm. , the controller is coupled with the mechanical arm, the industrial camera, the connector and the sensor; the method includes: the controller obtains the position information of the target interface collected by the industrial camera; the controller controls the mechanical arm according to the position information, so that the connector contacts the target interface ; The controller obtains the contact force between the connector and the target interface collected by the sensor; the controller adjusts the pose of the manipulator according to the contact force to reduce the contact force; when the contact force is less than the deviation threshold, the controller controls the manipulator, Insert the connector into the target interface.

根据上述接线方法,控制器根据工业相机采集的目标接口的位置信息,以及传感器采集的接触力,控制机械臂改变位姿,可以快速实现连接头与目标接口的高精度对接,从而提高电子设备调试效率。According to the above wiring method, the controller controls the mechanical arm to change the pose according to the position information of the target interface collected by the industrial camera and the contact force collected by the sensor, which can quickly realize the high-precision docking between the connector and the target interface, thereby improving the debugging of electronic equipment. efficiency.

在一种可选择的实现方式中,控制器根据接触力,调整机械臂位姿,以减小接触力包括:控制器判断接触力是否小于偏差阈值;如果接触力大于或者等于偏差阈值,控制器根据接触力计算位姿偏差;控制器根据位姿偏差调整机械臂位姿,以减小接触力。在本实现方式中,控制器通过比较接触力与偏差阈值的大小,可以判断出连接头与目标接口是否对准。并且,控制器可以根据位姿偏差调整机械臂位姿,使接触力小于偏差阈值,实现将连接头与目标接口对准。In an optional implementation, the controller adjusts the pose of the robotic arm according to the contact force to reduce the contact force, including: the controller judges whether the contact force is less than the deviation threshold; if the contact force is greater than or equal to the deviation threshold, the controller The pose deviation is calculated according to the contact force; the controller adjusts the pose of the manipulator according to the pose deviation to reduce the contact force. In this implementation, the controller can determine whether the connector is aligned with the target interface by comparing the contact force with the deviation threshold. Moreover, the controller can adjust the pose of the manipulator according to the pose deviation, so that the contact force is less than the deviation threshold, so as to align the connector with the target interface.

在一种可选择的实现方式中,接触力包括连接头与目标接口之间的力沿传感器三维坐标系上各轴的分量,以及连接头与目标接口之间的力绕传感器三维坐标系上各轴的力矩。在本实现方式中,控制器可以根据接触力从六个维度对机械臂进行精细化的位姿调整,提高连接头与目标接口的对准精度,实现连接头与目标接口的高精度对接。In an optional implementation, the contact force includes the components of the force between the connector and the target interface along each axis of the three-dimensional coordinate system of the sensor, and the components of the force between the connector and the target interface about each axis of the three-dimensional coordinate system of the sensor. shaft torque. In this implementation, the controller can finely adjust the pose of the robotic arm from six dimensions according to the contact force, improve the alignment accuracy between the connector and the target interface, and realize high-precision docking between the connector and the target interface.

在一种可选择的实现方式中,控制器根据接触力计算位姿偏差之前还包括:控制器获取惯性矩阵、阻尼矩阵和刚度矩阵。在本实现方式中,由于机械臂的位置与外界环境的接触力模型可以用一个二阶的“惯性-阻尼-弹簧”系统来等价表示,因此,控制器根据惯性矩阵、阻尼矩阵、刚度矩阵和接触力,可以计算得到位姿偏差。In an optional implementation manner, before the controller calculates the pose deviation according to the contact force, the controller further includes: the controller acquires an inertia matrix, a damping matrix, and a stiffness matrix. In this implementation, since the contact force model between the position of the manipulator and the external environment can be equivalently represented by a second-order "inertia-damping-spring" system, the controller, according to the inertia matrix, damping matrix, and stiffness matrix and contact force, the pose deviation can be calculated.

在一种可选择的实现方式中,接触力和位姿偏差满足以下公式:In an optional implementation, the contact force and pose deviation satisfy the following formula:

Figure BDA0003176045940000021
Figure BDA0003176045940000021

其中,F为接触力,ΔX为位姿偏差,M为惯性矩阵,B为阻尼矩阵,K为刚度矩阵;位姿偏差包括连接头沿传感器三维坐标系上各轴的平移量,以及连接头绕传感器三维坐标系上各轴的旋转角。Among them, F is the contact force, ΔX is the pose deviation, M is the inertia matrix, B is the damping matrix, and K is the stiffness matrix; the pose deviation includes the translation of the connector along each axis of the three-dimensional coordinate system of the sensor, and the rotation of the connector around The rotation angle of each axis on the sensor's three-dimensional coordinate system.

在一种可选择的实现方式中,判断接触力是否小于偏差阈值之前还包括:控制器判断接触力是否小于安全阈值;如果接触力大于或者等于安全阈值,控制器控制机械臂回退,使连接头和目标接口分离。在本实现方式中,控制器通过比较接触力与安全阈值的大小,可以判断出连接头与目标接口之间是否出现撞击的情况,防止连接头和目标接口的结构发生损坏,保证连接头与目标接口接触的安全性。In an optional implementation, before judging whether the contact force is less than the deviation threshold, it also includes: the controller judges whether the contact force is less than the safety threshold; if the contact force is greater than or equal to the safety threshold, the controller controls the mechanical arm to retreat to make the connection The header and target interfaces are separated. In this implementation, the controller can judge whether there is a collision between the connector and the target interface by comparing the contact force with the safety threshold, so as to prevent the structure of the connector and the target interface from being damaged, and ensure that the connector and the target interface Security of interface contact.

在一种可选择的实现方式中,位置信息包括目标接口在工业相机坐标系中的二维平面位置信息和深度信息;控制器获取工业相机采集的目标接口的位置信息,包括:控制器获取工业相机采集的第一图像和深度信息,第一图像包含目标接口;控制器将第一图像与预先存储的第二图像进行匹配,以从第一图像中获取目标接口的轮廓;控制器根据轮廓确定二维平面位置信息,二维平面位置信息包括轮廓的中心点坐标;控制器根据深度信息和中心点坐标得到目标接口在工业相机坐标系中的三维坐标信息。在本实现方式中,控制器通过工业相机可以获取目标接口在工业相机坐标系中的三维坐标信息,控制器根据三维坐标信息对机械臂的位姿进行调整,使连接头与目标接口接触。In an optional implementation, the position information includes two-dimensional plane position information and depth information of the target interface in the industrial camera coordinate system; the controller obtains the position information of the target interface collected by the industrial camera, including: the controller obtains the industrial The first image and depth information collected by the camera, the first image contains the target interface; the controller matches the first image with the pre-stored second image to obtain the outline of the target interface from the first image; the controller determines the Two-dimensional plane position information, the two-dimensional plane position information includes the center point coordinates of the outline; the controller obtains the three-dimensional coordinate information of the target interface in the industrial camera coordinate system according to the depth information and the center point coordinates. In this implementation mode, the controller can obtain the three-dimensional coordinate information of the target interface in the industrial camera coordinate system through the industrial camera, and the controller adjusts the pose of the robotic arm according to the three-dimensional coordinate information, so that the connector contacts the target interface.

在一种可选择的实现方式中,控制器将第一图像与预先存储的第二图像进行匹配,以从第一图像中获取目标接口的轮廓包括:控制器通过边缘检测算法从第一图像中获取目标接口的轮廓。In an optional implementation manner, the controller matching the first image with the pre-stored second image to obtain the outline of the target interface from the first image includes: the controller uses an edge detection algorithm to extract Get the outline of the target interface.

在一种可选择的实现方式中,控制器根据轮廓确定二维平面位置信息包括:控制器根据一阶中心矩计算二维平面位置信息。In an optional implementation manner, the controller determining the two-dimensional plane position information according to the contour includes: the controller calculating the two-dimensional plane position information according to the first-order central moment.

第二方面,本申请提供了一种接线系统,接线系统包括控制器、机械臂、工业相机、连接头和传感器,工业相机、连接头和传感器设置在机械臂的末端,控制器与机械臂、工业相机、连接头和传感器耦合;其中,工业相机,用于采集目标接口的位置信息;控制器,用于获取位置信息,根据位置信息,控制机械臂,使连接头与目标接口接触;传感器,用于采集连接头与目标接口之间的接触力;控制器,还用于获取接触力,根据接触力,调整机械臂位姿,以减小接触力;控制器,还用于在接触力小于偏差阈值时,控制机械臂,使连接头插入到目标接口中。In the second aspect, the present application provides a wiring system. The wiring system includes a controller, a robot arm, an industrial camera, a connector and a sensor. The industrial camera, the connector and the sensor are arranged at the end of the robot arm. The controller and the robot arm, The industrial camera, the connector and the sensor are coupled; among them, the industrial camera is used to collect the position information of the target interface; the controller is used to obtain the position information, and according to the position information, controls the mechanical arm to make the connector contact the target interface; the sensor, It is used to collect the contact force between the connector and the target interface; the controller is also used to obtain the contact force, and adjust the pose of the manipulator according to the contact force to reduce the contact force; the controller is also used to obtain the contact force when the contact force is less than When the deviation threshold is reached, the robotic arm is controlled to insert the connector into the target interface.

根据上述接线系统,控制器根据工业相机采集的目标接口的位置信息,以及传感器采集的接触力,控制机械臂改变位姿,可以快速实现连接头与目标接口的高精度对接,从而提高电子设备调试效率。According to the above wiring system, the controller controls the mechanical arm to change the pose according to the position information of the target interface collected by the industrial camera and the contact force collected by the sensor, which can quickly realize the high-precision docking of the connector and the target interface, thereby improving the debugging of electronic equipment. efficiency.

在一种可选择的实现方式中,控制器,还用于:判断接触力是否小于偏差阈值;如果接触力大于或者等于偏差阈值,根据接触力计算位姿偏差;根据位姿偏差调整机械臂位姿,以减小接触力。在本实现方式中,控制器通过比较接触力与偏差阈值的大小,可以判断出连接头与目标接口是否对准。并且,控制器可以根据位姿偏差调整机械臂位姿,使接触力小于偏差阈值,实现将连接头与目标接口对准。In an optional implementation, the controller is also used to: determine whether the contact force is less than the deviation threshold; if the contact force is greater than or equal to the deviation threshold, calculate the pose deviation according to the contact force; adjust the mechanical arm position according to the pose deviation position to reduce the contact force. In this implementation, the controller can determine whether the connector is aligned with the target interface by comparing the contact force with the deviation threshold. Moreover, the controller can adjust the pose of the manipulator according to the pose deviation, so that the contact force is less than the deviation threshold, so as to align the connector with the target interface.

在一种可选择的实现方式中,接触力包括连接头与目标接口之间的力沿传感器三维坐标系上各轴的分量,以及连接头与目标接口之间的力绕传感器三维坐标系上各轴的力矩。在本实现方式中,控制器可以根据接触力从六个维度对机械臂进行精细化的位姿调整,提高连接头与目标接口的对准精度,实现连接头与目标接口的高精度对接。In an optional implementation, the contact force includes the components of the force between the connector and the target interface along each axis of the three-dimensional coordinate system of the sensor, and the components of the force between the connector and the target interface about each axis of the three-dimensional coordinate system of the sensor. shaft torque. In this implementation, the controller can finely adjust the pose of the robotic arm from six dimensions according to the contact force, improve the alignment accuracy between the connector and the target interface, and realize high-precision docking between the connector and the target interface.

在一种可选择的实现方式中,控制器,还用于获取惯性矩阵、阻尼矩阵和刚度矩阵。在本实现方式中,由于机械臂的位置与外界环境的接触力模型可以用一个二阶的“惯性-阻尼-弹簧”系统来等价表示,因此,控制器根据惯性矩阵、阻尼矩阵、刚度矩阵和接触力,可以计算得到位姿偏差。In an optional implementation manner, the controller is also used to obtain an inertia matrix, a damping matrix and a stiffness matrix. In this implementation, since the contact force model between the position of the manipulator and the external environment can be equivalently represented by a second-order "inertia-damping-spring" system, the controller, according to the inertia matrix, damping matrix, and stiffness matrix and contact force, the pose deviation can be calculated.

在一种可选择的实现方式中,接触力和位姿偏差满足以下公式:In an optional implementation, the contact force and pose deviation satisfy the following formula:

Figure BDA0003176045940000031
Figure BDA0003176045940000031

其中,F为接触力,ΔX为位姿偏差,M为惯性矩阵,B为阻尼矩阵,K为刚度矩阵;位姿偏差包括连接头沿传感器三维坐标系上各轴的平移量,以及连接头绕传感器三维坐标系上各轴的旋转角。Among them, F is the contact force, ΔX is the pose deviation, M is the inertia matrix, B is the damping matrix, and K is the stiffness matrix; the pose deviation includes the translation of the connector along each axis of the three-dimensional coordinate system of the sensor, and the rotation of the connector around The rotation angle of each axis on the sensor's three-dimensional coordinate system.

在一种可选择的实现方式中,在判断接触力是否小于偏差阈值之前,控制器,还用于:判断接触力是否小于安全阈值;如果接触力大于或者等于安全阈值,控制机械臂回退,使连接头和目标接口分离。在本实现方式中,控制器通过比较接触力与安全阈值的大小,可以判断出连接头与目标接口之间是否出现撞击的情况,防止连接头和目标接口的结构发生损坏,保证连接头与目标接口接触的安全性。In an optional implementation, before judging whether the contact force is less than the deviation threshold, the controller is also used to: judge whether the contact force is less than the safety threshold; if the contact force is greater than or equal to the safety threshold, control the mechanical arm to retreat, Separate the connector from the target interface. In this implementation, the controller can judge whether there is a collision between the connector and the target interface by comparing the contact force with the safety threshold, so as to prevent the structure of the connector and the target interface from being damaged, and ensure that the connector and the target interface Security of interface contact.

在一种可选择的实现方式中,位置信息包括目标接口在工业相机坐标系中的二维平面位置信息和深度信息;控制器还用于:获取工业相机采集的第一图像和深度信息,第一图像包含目标接口;将第一图像与预先存储的第二图像进行匹配,以从第一图像中获取目标接口的轮廓;根据轮廓确定二维平面位置信息,二维平面位置信息包括轮廓的中心点坐标;根据深度信息和中心点坐标得到目标接口在工业相机坐标系中的三维坐标信息。在本实现方式中,控制器通过工业相机可以获取目标接口在工业相机坐标系中的三维坐标信息,控制器根据三维坐标信息对机械臂的位姿进行调整,使连接头与目标接口接触。In an optional implementation, the position information includes two-dimensional plane position information and depth information of the target interface in the industrial camera coordinate system; the controller is also used to: acquire the first image and depth information collected by the industrial camera, the first An image contains the target interface; matching the first image with the pre-stored second image to obtain the outline of the target interface from the first image; determining two-dimensional plane position information according to the outline, the two-dimensional plane position information including the center of the outline Point coordinates: According to the depth information and center point coordinates, the three-dimensional coordinate information of the target interface in the industrial camera coordinate system is obtained. In this implementation mode, the controller can obtain the three-dimensional coordinate information of the target interface in the industrial camera coordinate system through the industrial camera, and the controller adjusts the pose of the robotic arm according to the three-dimensional coordinate information, so that the connector contacts the target interface.

在一种可选择的实现方式中,控制器,还用于通过边缘检测算法从第一图像中获取目标接口的轮廓。In an optional implementation manner, the controller is further configured to acquire the outline of the target interface from the first image through an edge detection algorithm.

在一种可选择的实现方式中,控制器,还用于根据一阶中心矩计算二维平面位置信息。In an optional implementation manner, the controller is further configured to calculate two-dimensional plane position information according to the first-order central moment.

附图说明Description of drawings

图1为本申请实施例提供的一种天线接口和连接头的结构示意图;FIG. 1 is a schematic structural diagram of an antenna interface and a connector provided in an embodiment of the present application;

图2为本申请实施例提供的一种充电接口和连接头的结构示意图;FIG. 2 is a schematic structural diagram of a charging interface and a connector provided in an embodiment of the present application;

图3为本申请实施例提供的一种接线系统的结构框图;FIG. 3 is a structural block diagram of a wiring system provided in an embodiment of the present application;

图4为本申请实施例提供的一种接线系统的结构示意图;FIG. 4 is a schematic structural diagram of a wiring system provided by an embodiment of the present application;

图5为本申请实施例提供的一种连接头和传感器的结构示意图;FIG. 5 is a schematic structural diagram of a connector and a sensor provided in an embodiment of the present application;

图6为本申请实施例提供的一种连接头与目标接口初始位置的示意图;FIG. 6 is a schematic diagram of an initial position of a connector and a target interface provided by an embodiment of the present application;

图7为本申请实施例提供的一种连接头与目标接口接触的示意图;FIG. 7 is a schematic diagram of a connector contacting a target interface provided by an embodiment of the present application;

图8为本申请实施例提供的一种连接头插入目标接口的示意图;FIG. 8 is a schematic diagram of a connector inserted into a target interface provided by an embodiment of the present application;

图9为本申请实施例提供的一种目标接口的示意图;FIG. 9 is a schematic diagram of a target interface provided by an embodiment of the present application;

图10为本申请实施例提供的一种接线方法的流程图;FIG. 10 is a flowchart of a wiring method provided in an embodiment of the present application;

图11为本申请实施例提供的一种控制器获取工业相机采集的目标接口位置信息的方法流程图。Fig. 11 is a flow chart of a method for a controller to acquire the location information of a target interface collected by an industrial camera according to an embodiment of the present application.

具体实施方式Detailed ways

在本申请的描述中,除非另有说明,“/”表示“或”的意思,例如,A/B可以表示A或B。本文中的“和/或”仅仅是一种描述关联对象的关联关系,表示可以存在三种关系,例如,A和/或B,可以表示:单独存在A,同时存在A和B,单独存在B这三种情况。此外,“至少一个”是指一个或多个,“多个”是指两个或两个以上。“第一”、“第二”等字样并不对数量和执行次序进行限定,并且“第一”、“第二”等字样也并不限定一定不同。In the description of the present application, unless otherwise specified, "/" means "or", for example, A/B may mean A or B. The "and/or" in this article is just an association relationship describing associated objects, which means that there can be three relationships, for example, A and/or B, which can mean: A exists alone, A and B exist at the same time, and B exists alone These three situations. In addition, "at least one" means one or more, and "plurality" means two or more. Words such as "first" and "second" do not limit the number and order of execution, and words such as "first" and "second" do not necessarily limit the difference.

需要说明的是,本申请中,“示例性的”或者“例如”等词用于表示作例子、例证或说明。本申请中被描述为“示例性的”或者“例如”的任何实施例或设计方案不应被解释为比其他实施例或设计方案更优选或更具优势。确切而言,使用“示例性的”或者“例如”等词旨在以具体方式呈现相关概念。It should be noted that, in this application, words such as "exemplary" or "for example" are used as examples, illustrations or illustrations. Any embodiment or design described herein as "exemplary" or "for example" is not to be construed as preferred or advantageous over other embodiments or designs. Rather, the use of words such as "exemplary" or "such as" is intended to present related concepts in a concrete manner.

为了便于理解本申请的技术方案,下面结合附图,对本申请提供的技术方案的应用场景进行示例性说明。In order to facilitate the understanding of the technical solution of the present application, the application scenarios of the technical solution provided in the present application will be exemplarily described below in conjunction with the accompanying drawings.

手机、笔记本电脑等电子设备在出厂前或者维修时需要进行性能调试,以确保电子设备的各项功能完好,使用户可以正常使用电子设备。调试人员在对电子设备调试时,需要获取电子设备的调试数据,根据调试数据判断电子设备的性能是否完好。通常,调试人员需要使用调试数据线与电子设备建立连接,以获取电子设备的调试数据。针对电子设备的天线射频传导、电池充电等不同的性能调试,调试人员需要将不同的调试数据线与电子设备上对应的接口连接,其中,不同的调试数据线有不同形状的连接头。Electronic equipment such as mobile phones and laptops need to be debugged before leaving the factory or during maintenance to ensure that the functions of the electronic equipment are in good condition, so that users can use the electronic equipment normally. When debugging the electronic equipment, the debugging personnel need to obtain the debugging data of the electronic equipment, and judge whether the performance of the electronic equipment is intact according to the debugging data. Usually, a debugger needs to use a debug data cable to establish a connection with the electronic device, so as to obtain the debug data of the electronic device. For different performance debugging such as antenna radio frequency conduction and battery charging of electronic equipment, debugging personnel need to connect different debugging data lines to corresponding interfaces on the electronic equipment, wherein different debugging data lines have connectors of different shapes.

示例地,在对电子设备的天线进行射频传导测试时,调试人员需要将天线调试数据线与电子设备的天线接口连接。请参阅图1,图1为本申请实施例提供的一种天线接口和连接头的结构示意图,如图1所示,天线接口11位于电子设备的背部,天线接口11为圆形孔结构。天线连接头12位于天线调试数据线13的末端,连接头12的结构与天线接口11的结构相配合,当连接头12插入天线接口11后,连接头12的外壁可以与天线接口11的内壁紧密贴合,以实现天线调试数据的传输。For example, when performing a radio frequency conduction test on an antenna of an electronic device, a debugger needs to connect the antenna debugging data cable to the antenna interface of the electronic device. Please refer to FIG. 1 . FIG. 1 is a schematic structural diagram of an antenna interface and connector provided in the embodiment of the present application. As shown in FIG. 1 , the antenna interface 11 is located on the back of the electronic device, and the antenna interface 11 has a circular hole structure. The antenna connector 12 is located at the end of the antenna debugging data line 13. The structure of the connector 12 matches the structure of the antenna interface 11. When the connector 12 is inserted into the antenna interface 11, the outer wall of the connector 12 can be tightly connected to the inner wall of the antenna interface 11. Fit to realize the transmission of antenna debugging data.

示例地,在对电子设备进行充电调试时,调试人员需要将充电调试数据线与电子设备的充电接口连接。请参阅图2,图2为本申请实施例提供的一种充电接口和连接头的结构示意图,如图2所示,充电接口21位于电子设备的底部,充电接口21为圆角矩形孔结构。充电连接头22设置于充电调试数据线23的末端,充电连接头22的结构与充电接口21的结构相配合,当充电连接头22插入充电接口21后,充电连接头22的外壁可以与充电接口21的内壁紧密贴合,以实现充电调试数据的传输。For example, when charging and debugging an electronic device, a debugging person needs to connect a charging and debugging data cable to a charging interface of the electronic device. Please refer to FIG. 2 . FIG. 2 is a schematic structural diagram of a charging interface and connector provided in the embodiment of the present application. As shown in FIG. 2 , the charging interface 21 is located at the bottom of the electronic device, and the charging interface 21 has a rounded rectangular hole structure. The charging connector 22 is arranged at the end of the charging and debugging data line 23. The structure of the charging connector 22 matches the structure of the charging interface 21. When the charging connector 22 is inserted into the charging interface 21, the outer wall of the charging connector 22 can be connected to the charging interface. The inner wall of 21 is closely attached to realize the transmission of charging debugging data.

在实际的工作中,调试人员在对电子设备进行性能调试时,首先需要将待测电子设备放置于操作台,然后根据性能调试的需求选择对应连接头的调试数据线,最后通过肉眼观察电子设备的外部结构,找到性能调试需要连接的接口,手动将调试数据线插入接口。这一过程需要消耗较长的时间,导致电子设备调试效率很低。在大量的电子设备进行性能调试的情况下,如果每一台电子设备都通过调试人员人工对不同接口进行接线,将会大幅降低整个生产线或者维修线的调试效率,影响电子设备的交付速度。In actual work, when debugging the performance of electronic equipment, the debugger first needs to place the electronic device to be tested on the operating table, then select the debugging data cable corresponding to the connector according to the performance debugging requirements, and finally observe the electronic device with the naked eye Find the interface that needs to be connected for performance debugging, and manually insert the debugging data cable into the interface. This process takes a long time, resulting in low efficiency in debugging electronic equipment. In the case of performance debugging of a large number of electronic devices, if each electronic device is manually wired to different interfaces by debuggers, it will greatly reduce the debugging efficiency of the entire production line or maintenance line, and affect the delivery speed of electronic devices.

基于此,为了解决人工接线需要消耗较长的时间,从而导致电子设备调试效率低的问题,本申请实施例提供了一种接线方法。该方法可以在本申请提供的接线系统中实现。Based on this, in order to solve the problem that manual wiring takes a long time and thus leads to low debugging efficiency of electronic equipment, an embodiment of the present application provides a wiring method. This method can be implemented in the wiring system provided by this application.

本申请实施例提供的接线系统可以应用于与电子设备目标接口100的接线中。其中,电子设备包括但不限于手机、平板电脑、个人电脑、工作站设备、大屏设备(例如:智慧屏、智能电视等)、可穿戴设备(例如:智能手环、智能手表)掌上游戏机、家用游戏机、虚拟现实设备、增强现实设备、混合现实设备等、车载智能终端等,本申请不做具体限定。The wiring system provided by the embodiment of the present application can be applied to wiring with the electronic device target interface 100 . Among them, electronic devices include but are not limited to mobile phones, tablet computers, personal computers, workstation devices, large-screen devices (such as smart screens, smart TVs, etc.), wearable devices (such as smart bracelets, smart watches) handheld game consoles, Home game consoles, virtual reality devices, augmented reality devices, mixed reality devices, etc., vehicle-mounted smart terminals, etc., are not specifically limited in this application.

目标接口100为电子设备上待连接的接口。例如,可以是集成电路(inter-integrated circuit,I2C)接口,集成电路内置音频(inter-integrated circuit sound,I2S)接口,脉冲编码调制(pulse code modulation,PCM)接口,通用异步收发传输器(universal asynchronous receiver/transmitter,UART)接口,移动产业处理器接口(mobile industry processor interface,MIPI),通用输入输出(general-purposeinput/output,GPIO)接口,用户标识模块(subscriber identity module,SIM)接口,和/或通用串行总线(universal serial bus,USB)接口等,本申请不做具体限定。The target interface 100 is an interface to be connected on the electronic device. For example, it may be an integrated circuit (inter-integrated circuit, I2C) interface, an integrated circuit built-in audio (inter-integrated circuit sound, I2S) interface, a pulse code modulation (pulse code modulation, PCM) interface, a universal asynchronous transceiver (universal asynchronous receiver/transmitter, UART) interface, mobile industry processor interface (mobile industry processor interface, MIPI), general-purpose input-output (general-purpose input/output, GPIO) interface, subscriber identity module (subscriber identity module, SIM) interface, and /or a universal serial bus (universal serial bus, USB) interface, etc., which are not specifically limited in this application.

下面结合附图,对本申请提供的接线系统进行详细说明。The wiring system provided by the present application will be described in detail below with reference to the accompanying drawings.

请参阅图3,图3为本申请实施例提供的一种接线系统的结构框图。如图3所示,该接线系统包括控制器110、机械臂120、工业相机130、连接头140和传感器150,控制器110与机械臂120、工业相机130、连接头140和传感器150耦合。Please refer to FIG. 3 . FIG. 3 is a structural block diagram of a wiring system provided in an embodiment of the present application. As shown in FIG. 3 , the wiring system includes a controller 110 , a robot arm 120 , an industrial camera 130 , a connector 140 and a sensor 150 , and the controller 110 is coupled with the robot arm 120 , the industrial camera 130 , the connector 140 and the sensor 150 .

请参阅图4,图4为本申请实施例提供的一种接线系统的结构示意图。如图4所示,工业相机130、连接头140和传感器150设置在机械臂120的末端。在一种可选择的实现方式中,在机械臂120的末端还设置有安装基板121,工业相机130和传感器150固定在安装基板121上。可选的,安装基板121上设置有多个不同位置的安装螺纹孔,工业相机130和传感器150可通过螺纹连接固定在安装基板121上,这样的安装方式更加灵活,便于拆卸,可以根据使用需求调整工业相机130和传感器150在安装基板121上的位置。并且,当工业相机130和传感器150出现故障时,便于维修和更换工业相机130和传感器150。Please refer to FIG. 4 . FIG. 4 is a schematic structural diagram of a wiring system provided by an embodiment of the present application. As shown in FIG. 4 , an industrial camera 130 , a connector 140 and a sensor 150 are disposed at the end of the robot arm 120 . In an optional implementation manner, an installation substrate 121 is further provided at the end of the robot arm 120 , and the industrial camera 130 and the sensor 150 are fixed on the installation substrate 121 . Optionally, the mounting base 121 is provided with a plurality of mounting threaded holes in different positions, and the industrial camera 130 and the sensor 150 can be fixed on the mounting base 121 through screw connections. This installation method is more flexible and easy to disassemble. The positions of the industrial camera 130 and the sensor 150 on the mounting substrate 121 are adjusted. Also, when the industrial camera 130 and the sensor 150 fail, it is convenient to repair and replace the industrial camera 130 and the sensor 150 .

在本实施例中,连接头140固定在传感器150上,以便于传感器150获取连接头140的受力情况。图5为本申请实施例提供的一种连接头和传感器的结构示意图。如图5所示,可选的,在传感器150上可以设置有多个连接头140,每一个连接头140对应一种不同的形状的接口。这样,在对电子设备进行多项性能测试,需要分别连接不同形状接口的情况下,无需更换连接头140,只需要切换到与接口形状对应的连接头140,就可以实现与不同形状接口的连线,进一步提高了本申请提供的接线系统的适用性。In this embodiment, the connection head 140 is fixed on the sensor 150 so that the sensor 150 can obtain the force on the connection head 140 . FIG. 5 is a schematic structural diagram of a connector and a sensor provided in an embodiment of the present application. As shown in FIG. 5 , optionally, multiple connectors 140 may be provided on the sensor 150 , and each connector 140 corresponds to an interface of a different shape. In this way, when multiple performance tests are performed on electronic equipment and interfaces of different shapes need to be connected separately, there is no need to replace the connector 140, only need to switch to the connector 140 corresponding to the shape of the interface, and the connection with the interface of different shapes can be realized. wire, which further improves the applicability of the wiring system provided by the present application.

在本实施例中,控制器110与机械臂120、工业相机130、连接头140和传感器150耦合。具体的,控制器110与机械臂120、工业相机130、连接头140和传感器150之间可以通过数据线有线连接,或者,通过无线通信模块进行无线连接,例如无线保真(wirelessfidelity,Wi-Fi)、蓝牙bluetooth、蓝牙网状网络(蓝牙mesh)等。In this embodiment, the controller 110 is coupled with the robot arm 120 , the industrial camera 130 , the connector 140 and the sensor 150 . Specifically, the controller 110 can be wired with the mechanical arm 120, the industrial camera 130, the connector 140, and the sensor 150, or can be connected wirelessly through a wireless communication module, such as a wireless fidelity (Wi-Fi ), Bluetooth bluetooth, Bluetooth mesh network (Bluetooth mesh), etc.

本申请实施例中的控制器110用于获取工业相机130采集的目标接口100的位置信息;根据位置信息,控制机械臂120,使连接头140与目标接口100接触;获取传感器150采集的连接头140与目标接口100之间的接触力;根据接触力,调整机械臂120位姿,以减小接触力;在接触力小于偏差阈值时,控制机械臂120,使连接头140插入到目标接口100中。The controller 110 in the embodiment of the present application is used to obtain the position information of the target interface 100 collected by the industrial camera 130; according to the position information, control the mechanical arm 120 to make the connector 140 contact the target interface 100; obtain the connector collected by the sensor 150 140 and the target interface 100; according to the contact force, adjust the posture of the mechanical arm 120 to reduce the contact force; when the contact force is less than the deviation threshold, control the mechanical arm 120 to insert the connector 140 into the target interface 100 middle.

在本实施例中,请参阅图6,图6为本申请实施例提供的一种连接头与目标接口初始位置的示意图。如图6所示,在接线系统进行接线前,连接头140与目标接口100之间存在一定的距离。因此,控制器110首先获取工业相机130采集的目标接口100的位置信息,根据位置信息对目标接口100进行初步定位,通过控制机械臂120,使连接头140与目标接口100接触。图7为本申请实施例提供的一种连接头与目标接口接触的示意图。如图7所示,连接头140已经与目标接口100接触,但是连接头140并没有插入目标接口100中。接下来,获取传感器150采集的连接头140与目标接口100之间的接触力,根据接触力对目标接口100进行精确定位,通过调整机械臂120位姿,以减小接触力。最后,当接触力小于偏差阈值时,控制器110控制机械臂120,使连接头140插入到目标接口100中,以实现连接头140与目标接口100的高精度对接。图8为本申请实施例提供的一种连接头插入目标接口的示意图。如图8所示,连接头140已经准确插入到目标接口100中。In this embodiment, please refer to FIG. 6 , which is a schematic diagram of an initial position of a connection head and a target interface provided by an embodiment of the present application. As shown in FIG. 6 , before the wiring system performs wiring, there is a certain distance between the connector 140 and the target interface 100 . Therefore, the controller 110 first obtains the position information of the target interface 100 collected by the industrial camera 130 , performs preliminary positioning of the target interface 100 according to the position information, and controls the mechanical arm 120 to make the connector 140 contact the target interface 100 . FIG. 7 is a schematic diagram of a connector contacting a target interface provided by an embodiment of the present application. As shown in FIG. 7 , the connector 140 has been in contact with the target interface 100 , but the connector 140 is not inserted into the target interface 100 . Next, the contact force between the connector 140 and the target interface 100 collected by the sensor 150 is obtained, the target interface 100 is precisely positioned according to the contact force, and the posture of the mechanical arm 120 is adjusted to reduce the contact force. Finally, when the contact force is less than the deviation threshold, the controller 110 controls the robotic arm 120 to insert the connector 140 into the target interface 100 , so as to achieve high-precision docking between the connector 140 and the target interface 100 . FIG. 8 is a schematic diagram of a connector inserted into a target interface provided by an embodiment of the present application. As shown in FIG. 8 , the connector 140 has been correctly inserted into the target interface 100 .

由此可见,本申请提供的接线系统,通过控制器110控制机械臂120,结合工业相机130和传感器150,可以快速实现连接头140与目标接口100的高精度对接,从而提高电子设备调试效率。It can be seen that the wiring system provided by the present application controls the mechanical arm 120 through the controller 110, and combines the industrial camera 130 and the sensor 150 to quickly realize high-precision docking between the connector 140 and the target interface 100, thereby improving the debugging efficiency of electronic equipment.

需要说明的是,在控制器110根据接触力调整机械臂120位姿的过程中,为了提高连接头140与目标接口100对接的精度,控制器110可以是实时持续的获取连接头140与目标接口100之间的接触力。但是,这样会增加控制器110计算的数据量以及接线系统的能耗。为了降低接线系统的能耗,提高接线效率,控制器110可以以一定的采样频率获取接触力,或者,通过设置位姿变化阈值,当机械臂120的位姿变化大于位姿变化阈值时,控制器110获取接触力。本申请对此不做具体限定。It should be noted that, in the process of the controller 110 adjusting the pose of the robotic arm 120 according to the contact force, in order to improve the accuracy of the connection between the connector 140 and the target interface 100, the controller 110 can continuously obtain the connection between the connector 140 and the target interface in real time. Contact force between 100. However, this will increase the amount of data calculated by the controller 110 and the power consumption of the wiring system. In order to reduce the energy consumption of the wiring system and improve the wiring efficiency, the controller 110 can obtain the contact force at a certain sampling frequency, or, by setting the pose change threshold, when the pose change of the mechanical arm 120 is greater than the pose change threshold, control The device 110 captures the contact force. This application does not specifically limit it.

在本实施例中,控制器110可以包括一个或多个处理单元,例如:控制器110可以包括应用处理器(application processor,AP),调制解调处理器,图形处理器(graphicsprocessing unit,GPU),图像信号处理器(image signal processor,ISP),视频编解码器,数字信号处理器(digital signal processor,DSP),基带处理器,和/或神经网络处理器(neural-network processing unit,NPU)等。其中,不同的处理单元可以是独立的器件,也可以集成在一个或多个处理器中,例如集成在系统芯片(system on a chip,SoC)中。控制器110中还可以设置存储器,用于存储指令和数据。在一些实施例中,控制器110中的存储器为高速缓冲存储器。该存储器可以保存控制器刚用过或循环使用的指令或数据。In this embodiment, the controller 110 may include one or more processing units, for example: the controller 110 may include an application processor (application processor, AP), a modem processor, a graphics processing unit (graphics processing unit, GPU) , image signal processor (image signal processor, ISP), video codec, digital signal processor (digital signal processor, DSP), baseband processor, and/or neural network processor (neural-network processing unit, NPU) wait. Wherein, different processing units may be independent devices, or may be integrated into one or more processors, for example, integrated into a system on a chip (SoC). A memory may also be provided in the controller 110 for storing instructions and data. In some embodiments, the memory in controller 110 is a cache memory. This memory can hold instructions or data that the controller has just used or recycled.

本申请实施例中的机械臂120用于根据控制器110的控制指令调整位置和姿态,使连接头140准确的插入到目标接口100中。其中,机械臂120是一种能够接受指令,精确地定位到三维或二维空间上的某一点进行作业的自动化机械装置。机械臂根据结构形式的不同分为多关节机械臂,直角坐标系机械臂,球坐标系机械臂,极坐标机械臂,柱坐标机械臂等。在本实施例中机械臂120优选为一种可以实现六自由度运动的多关节机械手臂,即机械臂120可以实现沿其三维坐标系的X轴、Y轴和Z轴的移动和旋转。通过控制机械臂120在六个自由度上的运动,可以调整机械臂120的位置和姿态,从而改变设置在机械臂120末端的连接头140的位置,实现将连接头140插入目标接口100中。The robotic arm 120 in the embodiment of the present application is used to adjust the position and posture according to the control instruction of the controller 110 , so that the connector 140 can be accurately inserted into the target interface 100 . Wherein, the robotic arm 120 is an automatic mechanical device capable of accepting instructions and precisely positioning to a certain point in a three-dimensional or two-dimensional space for operation. According to different structural forms, the robotic arm is divided into multi-joint robotic arm, rectangular coordinate robotic arm, spherical coordinate robotic arm, polar coordinate robotic arm, cylindrical coordinate robotic arm, etc. In this embodiment, the robotic arm 120 is preferably a multi-joint robotic arm that can move in six degrees of freedom, that is, the robotic arm 120 can move and rotate along the X-axis, Y-axis, and Z-axis of its three-dimensional coordinate system. By controlling the movement of the mechanical arm 120 in six degrees of freedom, the position and posture of the mechanical arm 120 can be adjusted, thereby changing the position of the connector 140 disposed at the end of the mechanical arm 120 , and inserting the connector 140 into the target interface 100 .

本申请实施例中的工业相机130用于采集目标接口100的位置信息。工业相机130是一种将光信号转变成有序电信号的摄像机,具有高的图像稳定性、高传输能力和高抗干扰能力等优势。在一种可选择的实现方式中,工业相机130优选为深度相机,工业相机130采集的位置信息包括目标接口100在工业相机130坐标系中的二维平面位置信息和深度信息。深度相机不仅具有拍摄物体图像的功能,而且具有深度测量功能。通过深度相机获取到的数据,可以准确的获得图像中每个点到深度相机摄像头的距离,结合该点在二维图像中的坐标值,就可以获取图像中每个点的三维坐标值。具体的,工业相机130可以是结构光(structured-light)深度相机、双目立体视觉(binocular stereo vision)深度相机和光飞行时间(time of flight,TOF)深度相机等,本申请不做具体限定。The industrial camera 130 in the embodiment of the present application is used to collect the location information of the target interface 100 . The industrial camera 130 is a camera that converts optical signals into orderly electrical signals, and has the advantages of high image stability, high transmission capacity, and high anti-interference ability. In an optional implementation manner, the industrial camera 130 is preferably a depth camera, and the position information collected by the industrial camera 130 includes two-dimensional plane position information and depth information of the target interface 100 in the coordinate system of the industrial camera 130 . Depth cameras not only have the function of taking images of objects, but also have the function of depth measurement. Through the data obtained by the depth camera, the distance from each point in the image to the camera of the depth camera can be accurately obtained, and combined with the coordinate value of the point in the two-dimensional image, the three-dimensional coordinate value of each point in the image can be obtained. Specifically, the industrial camera 130 may be a structured-light depth camera, a binocular stereo vision (binocular stereo vision) depth camera, a time of flight (TOF) depth camera, etc., which are not specifically limited in this application.

本申请实施例中的连接头140用于与目标接口100连接,实现数据传输。例如,连接头140可以是天线射频(radio-frequency)连接头,Micro USB连接头,USB Type C连接头和Lightning连接头等。可以理解的是,连接头140与数据线连接,以实现调试数据的传输。在本实施例中,连接头140的结构与目标接口100的结构相匹配,使连接头140插入目标接口100后不会破坏目标接口100的结构,并且连接头140可以实现传输数据的功能。The connector 140 in the embodiment of the present application is used to connect with the target interface 100 to realize data transmission. For example, the connector 140 may be an antenna radio-frequency (radio-frequency) connector, a Micro USB connector, a USB Type C connector, a Lightning connector, and the like. It can be understood that the connection head 140 is connected with the data line to realize the transmission of debugging data. In this embodiment, the structure of the connector 140 matches the structure of the target interface 100, so that the structure of the target interface 100 will not be damaged after the connector 140 is inserted into the target interface 100, and the connector 140 can realize the function of data transmission.

本申请实施例中的传感器150用于采集连接头140与目标接口100之间的接触力。具体的,传感器150是一种力传感器,可以将力的量值转换为相关电信号。在一种可选择的实现方式中,传感器150优选为六维力传感器,六维力传感器是一种能够同时测量X轴、Y轴和Z轴三个方向的力与力矩的传感器。在本实施例中,传感器150采集的接触力包括连接头140与目标接口100之间的力沿传感器150三维坐标系上各轴的分量,以及连接头140与目标接口100之间的力绕传感器150三维坐标系上各轴的力矩。The sensor 150 in the embodiment of the present application is used to collect the contact force between the connecting head 140 and the target interface 100 . Specifically, the sensor 150 is a force sensor that can convert the magnitude of force into a related electrical signal. In an optional implementation manner, the sensor 150 is preferably a six-dimensional force sensor, which is a sensor capable of simultaneously measuring forces and moments in three directions of the X-axis, Y-axis and Z-axis. In this embodiment, the contact force collected by the sensor 150 includes the components of the force between the connector 140 and the target interface 100 along each axis of the three-dimensional coordinate system of the sensor 150, and the force between the connector 140 and the target interface 100 around the sensor 150 The moment of each axis on the three-dimensional coordinate system.

在一种可选择的实现方式中,控制器110还用于:判断接触力是否小于偏差阈值;如果接触力大于或者等于偏差阈值,根据接触力计算位姿偏差;根据位姿偏差调整机械臂120位姿,以减小接触力。In an optional implementation, the controller 110 is also used to: determine whether the contact force is less than the deviation threshold; if the contact force is greater than or equal to the deviation threshold, calculate the pose deviation according to the contact force; adjust the mechanical arm 120 according to the pose deviation pose to reduce the contact force.

在本实施例中,控制器110通过比较接触力与偏差阈值的大小,可以判断连接头140与目标接口100是否对准,以实现连接头140与目标接口100的高精度对接。其中,连接头140与目标接口100是否对准可以理解为,连接头140的中轴线与目标接口100的中轴线是否重合。如果接触力小于偏差阈值,则说明连接头140与目标接口100已经对准,可以将连接头140插入目标接口100中。如果接触力大于或者等于偏差阈值,则说明连接头140与目标接口100没有对准,位置还存在偏差,需要根据接触力计算位姿偏差,根据位姿偏差调整机械臂120位姿,再次获取传感器150采集的连接头140与目标接口100之间的接触力,直至接触力小于偏差阈值。In this embodiment, the controller 110 can determine whether the connector 140 is aligned with the target interface 100 by comparing the contact force with the deviation threshold, so as to realize high-precision docking between the connector 140 and the target interface 100 . Wherein, whether the connecting head 140 is aligned with the target interface 100 can be understood as whether the central axis of the connecting head 140 coincides with the central axis of the target interface 100 . If the contact force is less than the deviation threshold, it means that the connector 140 has been aligned with the target interface 100 , and the connector 140 can be inserted into the target interface 100 . If the contact force is greater than or equal to the deviation threshold, it means that the connector 140 is not aligned with the target interface 100, and there is still a deviation in position. It is necessary to calculate the pose deviation according to the contact force, adjust the pose of the robotic arm 120 according to the pose deviation, and obtain the sensor again. 150 collects the contact force between the connector 140 and the target interface 100 until the contact force is less than the deviation threshold.

需要说明的是,偏差阈值根据实际的应用场景以及对接精度的要求进行确定。如果连接头140与目标接口100完全对齐,各个维度的接触力应该接近于零,因此,偏差阈值取值越小,连接头140与样机接口100对准的精度越高。在一些实施例中,连接头140与目标接口100之间的力沿传感器150三维坐标系上各轴的分量的偏差阈值优选取值范围为:1N-1.5N,连接头140与目标接口100之间的力绕传感器150三维坐标系上各轴的力矩的偏差阈值优选取值范围为:0.01Nm-0.015Nm。当偏差阈值的取值在上述优选取值范围内时,如果接触力小于该偏差阈值,则可以认为连接头140与目标接口100近似对准,连接头140可以与目标接口100进行对接。It should be noted that the deviation threshold is determined according to actual application scenarios and requirements for docking accuracy. If the connector 140 is perfectly aligned with the target interface 100 , the contact force in each dimension should be close to zero. Therefore, the smaller the value of the deviation threshold, the higher the alignment accuracy of the connector 140 and the prototype interface 100 . In some embodiments, the deviation threshold of the force between the connector 140 and the target interface 100 along each axis of the three-dimensional coordinate system of the sensor 150 is preferably in the range of 1N-1.5N, between the connector 140 and the target interface 100 The preferred value range of the torque deviation threshold of each axis on the three-dimensional coordinate system of the force around the sensor 150 is: 0.01Nm-0.015Nm. When the value of the deviation threshold is within the above preferred value range, if the contact force is smaller than the deviation threshold, it can be considered that the connector 140 is approximately aligned with the target interface 100 , and the connector 140 can be docked with the target interface 100 .

在一种可选择的实现方式中,在控制器110根据接触力计算位姿偏差之前,控制器110,还用于获取惯性矩阵、阻尼矩阵和刚度矩阵。在本实施例中,机械臂120的位置与外界环境的接触力模型可以用一个二阶的“惯性-阻尼-弹簧”系统来等价表示。具体的,通过惯性矩阵、阻尼矩阵和刚度矩阵分别从惯性、阻尼和弹簧三个方面,来表示机械臂120的位置与外界环境的接触力之间的关系,因此,在根据接触力计算位姿偏差前,首先要获取惯性矩阵、阻尼矩阵和刚度矩阵。惯性矩阵、阻尼矩阵和刚度矩阵三个矩阵均为常值矩阵,三个矩阵的取值与机械臂120和外界环境有关,需要通过实验调整到合适的数值。本申请对惯性矩阵、阻尼矩阵和刚度矩阵的取值不做限定。In an optional implementation manner, before the controller 110 calculates the pose deviation according to the contact force, the controller 110 is further configured to acquire an inertia matrix, a damping matrix, and a stiffness matrix. In this embodiment, the position of the mechanical arm 120 and the contact force model of the external environment can be equivalently represented by a second-order "inertia-damping-spring" system. Specifically, the relationship between the position of the manipulator 120 and the contact force of the external environment is expressed from the three aspects of inertia, damping and spring through the inertia matrix, damping matrix and stiffness matrix. Therefore, when calculating the pose according to the contact force Before deviation, the inertia matrix, damping matrix and stiffness matrix must be obtained first. The three matrices of inertia matrix, damping matrix and stiffness matrix are all constant value matrices. The values of the three matrices are related to the mechanical arm 120 and the external environment, and need to be adjusted to appropriate values through experiments. This application does not limit the values of the inertia matrix, damping matrix and stiffness matrix.

在一种可选择的实现方式中,接触力和位姿偏差满足以下公式:In an optional implementation, the contact force and pose deviation satisfy the following formula:

Figure BDA0003176045940000081
Figure BDA0003176045940000081

其中,F为接触力,ΔX为位姿偏差,M为惯性矩阵,B为阻尼矩阵,K为刚度矩阵。Among them, F is the contact force, ΔX is the pose deviation, M is the inertia matrix, B is the damping matrix, and K is the stiffness matrix.

具体的,F展开后的表达式为:Specifically, the expanded expression of F is:

Figure BDA0003176045940000082
Figure BDA0003176045940000082

其中,Fx,Fy和Fz分别表示连接头140与目标接口100之间的力沿传感器150三维坐标系X轴、Y轴和Z轴的分量,Tx,Ty和Tz分别表示连接头140与目标接口100之间的力绕传感器150三维坐标系X轴、Y轴和Z轴的力矩。Wherein, Fx, Fy and Fz respectively represent the components of the force between the connector 140 and the target interface 100 along the X-axis, Y-axis and Z-axis of the three-dimensional coordinate system of the sensor 150, and Tx, Ty and Tz respectively represent the components of the connector 140 and the target interface. The force between 100 is the moment about the X-axis, Y-axis and Z-axis of the three-dimensional coordinate system of the sensor 150 .

ΔX展开后的表达式为:The expanded expression of ΔX is:

Figure BDA0003176045940000083
Figure BDA0003176045940000083

其中,Δx,Δy和Δz分别表示连接头140沿传感器150三维坐标系上X轴、Y轴和Z轴的平移量,Δα,Δβ和Δγ分别表示连接头140绕传感器150三维坐标系上X轴、Y轴和Z轴的旋转角。Among them, Δx, Δy and Δz respectively represent the translation of the connector 140 along the X-axis, Y-axis and Z-axis on the three-dimensional coordinate system of the sensor 150, and Δα, Δβ and Δγ respectively represent the translation of the connector 140 around the X-axis on the three-dimensional coordinate system of the sensor 150 , the rotation angle of the Y axis and the Z axis.

在本实施例中,在根据接触力计算位姿偏差的过程中,将上述公式①离散化,通过数值迭代求解可以得到位姿偏差,具体迭代过程的表达式如下:In this embodiment, in the process of calculating the pose deviation according to the contact force, the above formula ① is discretized, and the pose deviation can be obtained through numerical iterative solution. The expression of the specific iterative process is as follows:

Figure BDA0003176045940000084
Figure BDA0003176045940000084

其中,λ为迭代周期,n为本次迭代次数。Among them, λ is the iteration cycle, and n is the number of iterations this time.

需要说明的是,传感器150采集的接触力处于传感器150的三维坐标系下,为了便于控制器110根据位姿偏差准确的调整机械臂120的位姿,需要将位姿偏差转换到用于控制机械臂位姿的坐标系下,例如,机械臂120的基坐标系或者世界坐标系下。具体的,可以首先将接触力由传感器150的三维坐标系转换到用于控制机械臂位姿的坐标系下,再根据接触力计算位姿偏差,这样获得的位姿偏差就处于用于控制机械臂位姿的坐标系下。或者,首先根据接触力计算位姿偏差,此时位姿偏差处于传感器150的三维坐标系下,然后再将位姿偏差由传感器150的三维坐标系转换到用于控制机械臂位姿的坐标系下。It should be noted that the contact force collected by the sensor 150 is in the three-dimensional coordinate system of the sensor 150. In order for the controller 110 to accurately adjust the pose of the mechanical arm 120 according to the pose deviation, it is necessary to convert the pose deviation into In the coordinate system of the arm pose, for example, in the base coordinate system or the world coordinate system of the robotic arm 120 . Specifically, the contact force can be converted from the three-dimensional coordinate system of the sensor 150 to the coordinate system used to control the pose of the manipulator, and then the pose deviation is calculated according to the contact force. In the coordinate system of the arm pose. Or, first calculate the pose deviation according to the contact force, at this time, the pose deviation is in the three-dimensional coordinate system of the sensor 150, and then convert the pose deviation from the three-dimensional coordinate system of the sensor 150 to the coordinate system used to control the pose of the manipulator Down.

在一种可选择的实现方式中,在判断接触力是否小于偏差阈值之前,控制器110,还用于:判断接触力是否小于安全阈值;如果接触力大于或者等于安全阈值,控制机械臂120回退,使连接头140和目标接口100分离。In an optional implementation, before judging whether the contact force is less than the deviation threshold, the controller 110 is also used to: judge whether the contact force is less than the safety threshold; if the contact force is greater than or equal to the safety threshold, control the mechanical arm 120 back to Step back to separate the connector 140 from the target interface 100.

在本实施例中,在控制器110根据接触力调整机械臂120的位姿之前,控制器110首先通过判断接触力是否小于安全阈值,以防止连接头140与目标接口100出现撞击而导致结构损坏的情况。具体的,如果接触力大于或者等于安全阈值,说明连接头140与目标接口100之间的接触力较大,连接头140与目标接口100之间可能出现撞击的情况,控制器110需要及时控制机械臂120回退,使连接头140和目标接口100分离,防止连接头140或者目标接口100的结构发生损坏。如果接触力小于安全阈值,说明连接头140与目标接口100之间的接触力在安全范围内,控制器110可以进一步通过判断接触力是否小于偏差阈值,精细化调整机械臂120的位姿,将连接头14与目标接口100对准。In this embodiment, before the controller 110 adjusts the pose of the robotic arm 120 according to the contact force, the controller 110 first judges whether the contact force is less than a safety threshold to prevent the connection head 140 from colliding with the target interface 100 and causing structural damage Case. Specifically, if the contact force is greater than or equal to the safety threshold, it indicates that the contact force between the connector 140 and the target interface 100 is relatively large, and there may be a collision between the connector 140 and the target interface 100, and the controller 110 needs to control the mechanical The arm 120 retreats to separate the connecting head 140 from the target interface 100 , preventing damage to the structure of the connecting head 140 or the target interface 100 . If the contact force is less than the safety threshold, it means that the contact force between the connector 140 and the target interface 100 is within the safe range. The controller 110 can further fine-tune the pose of the mechanical arm 120 by judging whether the contact force is less than the deviation threshold. Connector 14 is aligned with target interface 100 .

需要说明的是,安全阈值根据实际的需求进行确定。为了保证连接头140与目标接口100之间接触的安全性,安全阈值的取值要大于偏差阈值。在一些实施例中,连接头140与目标接口100之间的力沿传感器150三维坐标系上各轴的分量的安全阈值优选取值范围为:10N-15N,连接头140与目标接口100之间的力绕传感器150三维坐标系上各轴的力矩的安全阈值优选取值范围为:0.1Nm-0.15Nm。当安全阈值的取值在上述优选取值范围内时,如果接触力小于该安全阈值,则可以认为连接头140与目标接口100之间的接触力安全。It should be noted that the security threshold is determined according to actual requirements. In order to ensure the safety of the contact between the connecting head 140 and the target interface 100, the value of the safety threshold should be greater than the deviation threshold. In some embodiments, the preferred safety threshold of the component of the force between the connector 140 and the target interface 100 along each axis on the three-dimensional coordinate system of the sensor 150 is: 10N-15N, between the connector 140 and the target interface 100 The preferred value range of the safety threshold of the torque of each axis on the three-dimensional coordinate system of the force-circling sensor 150 is: 0.1Nm-0.15Nm. When the value of the safety threshold is within the above preferred value range, if the contact force is smaller than the safety threshold, it can be considered that the contact force between the connector 140 and the target interface 100 is safe.

在一种可选择的实现方式中,位置信息包括目标接口100在工业相机130坐标系中的二维平面位置信息和深度信息。控制器110还用于:获取工业相机130采集的第一图像和深度信息,第一图像包含目标接口100;将第一图像与预先存储的第二图像进行匹配,以从第一图像中获取目标接口100的轮廓;根据轮廓确定二维平面位置信息,二维平面位置信息包括轮廓的中心点坐标;根据深度信息和中心点坐标得到目标接口100在工业相机130坐标系中的三维坐标信息。In an optional implementation manner, the position information includes two-dimensional plane position information and depth information of the target interface 100 in the coordinate system of the industrial camera 130 . The controller 110 is also used to: obtain the first image and depth information collected by the industrial camera 130, the first image includes the target interface 100; match the first image with the pre-stored second image to obtain the target from the first image The outline of the interface 100; determine the two-dimensional plane position information according to the outline, and the two-dimensional plane position information includes the center point coordinates of the outline; obtain the three-dimensional coordinate information of the target interface 100 in the industrial camera 130 coordinate system according to the depth information and the center point coordinates.

在本实施例中,请参阅图9,图9为本申请实施例提供的一种目标接口100的示意图。如图9所示,电子设备上设置有多个接口,但是连接头140只与其中的目标接口100连接。工业相机130首先对电子设备整体的外部结构进行采集,工业相机130采集的第一图像中不仅包含目标接口100的图像,而且还可能包含电子设备上的其他接口图像。因此,首先需要在第一图像中找到目标接口100。第二图像为预先存储的目标接口100图像,通过第一图像与第二图像进行匹配,可以准确的找到目标接口100,并提取出目标接口100的轮廓,以用于确定目标接口100的二维平面位置信息,其中,以轮廓的中心点坐标表示目标接口100的二维平面位置信息。In this embodiment, please refer to FIG. 9 , which is a schematic diagram of a target interface 100 provided in an embodiment of the present application. As shown in FIG. 9 , multiple interfaces are provided on the electronic device, but the connector 140 is only connected to the target interface 100 among them. The industrial camera 130 first collects the overall external structure of the electronic device, and the first image collected by the industrial camera 130 not only includes the image of the target interface 100, but may also include images of other interfaces on the electronic device. Therefore, it is first necessary to find the target interface 100 in the first image. The second image is a pre-stored image of the target interface 100. By matching the first image with the second image, the target interface 100 can be accurately found, and the outline of the target interface 100 can be extracted to determine the two-dimensional shape of the target interface 100. The plane position information, wherein the two-dimensional plane position information of the target interface 100 is represented by the coordinates of the center point of the outline.

在一些实施例中,在接线系统对目标接口100进行接线前,可以预先存储多张第二图像,每个第二图像对应不同的目标接口100图像,需要说明的是,此时接线系统中也包括多个与目标接口100对应的连接头140。根据工业相机130采集的第一图像可以依次匹配出第二图像对应的目标接口100,并选择与目标接口100对应的连接头140进行连接。这样,不仅可以增加本申请实施例提供接线系统的适配性,而且可以进一步提高接线效率。In some embodiments, before the wiring system connects the target interface 100, multiple second images may be stored in advance, and each second image corresponds to a different image of the target interface 100. It should be noted that, at this time, the wiring system also A plurality of connectors 140 corresponding to the target interface 100 are included. According to the first image captured by the industrial camera 130 , the target interface 100 corresponding to the second image can be matched sequentially, and the connector 140 corresponding to the target interface 100 can be selected for connection. In this way, not only the adaptability of the wiring system provided by the embodiment of the present application can be increased, but also the wiring efficiency can be further improved.

在一种可选择的实现方式中,控制器110,还用于通过边缘检测算法从第一图像中获取目标接口100的轮廓。边缘检测算法是一种可以通过标识数字图像中亮度变化明显的点,从而提取图像中边缘的算法。因此,控制器110通过边缘检测算法可以有效的从第一图像中提取目标接口100的轮廓。具体的,边缘检测算法包括:Sobel算子检测算法,Laplacian算子检测算法和Canny算子检测算法等。本申请对边缘检测采用的具体算法不做具体限定。In an optional implementation manner, the controller 110 is further configured to acquire the outline of the target interface 100 from the first image through an edge detection algorithm. The edge detection algorithm is an algorithm that can extract the edges in the image by identifying the points with obvious brightness changes in the digital image. Therefore, the controller 110 can effectively extract the outline of the target interface 100 from the first image through the edge detection algorithm. Specifically, the edge detection algorithm includes: a Sobel operator detection algorithm, a Laplacian operator detection algorithm, a Canny operator detection algorithm, and the like. This application does not specifically limit the specific algorithm adopted by the edge detection.

在一种可选择的实现方式中,控制器110,还用于根据一阶中心矩计算二维平面位置信息。在本实施例中,由于二维图像空间矩的实质为面积,因此可以通过一阶矩计算二维图像中某一个轮廓图形的中心点坐标。控制器110根据轮廓通过一阶中心矩计算确定二维平面位置信息,即得到轮廓的中心点坐标。轮廓的中心点坐标用于目标接口100的初步定位,控制器110根据轮廓的中心点坐标,控制机械臂120,使连接头140与目标接口100接触。In an optional implementation manner, the controller 110 is further configured to calculate two-dimensional plane position information according to the first-order central moment. In this embodiment, since the space moment of the two-dimensional image is essentially the area, the coordinates of the central point of a contour figure in the two-dimensional image can be calculated through the first-order moment. The controller 110 determines the two-dimensional plane position information by calculating the first-order central moment according to the contour, that is, obtains the coordinates of the central point of the contour. The coordinates of the center point of the contour are used for preliminary positioning of the target interface 100 , and the controller 110 controls the robot arm 120 to make the connecting head 140 contact with the target interface 100 according to the coordinates of the center point of the contour.

本申请实施例还提供了一种接线方法,该方法可以应用于本申请实施例提供的任一接线系统中。请参阅图10,图10为本申请实施例提供的一种接线方法的流程图。如图10所示,该方法包括步骤S101—步骤S108:The embodiment of the present application also provides a wiring method, which can be applied to any wiring system provided in the embodiment of the present application. Please refer to FIG. 10 . FIG. 10 is a flowchart of a wiring method provided by an embodiment of the present application. As shown in Figure 10, the method includes step S101-step S108:

步骤S101:控制器110获取工业相机130采集的目标接口100的位置信息。Step S101 : the controller 110 obtains the position information of the target interface 100 collected by the industrial camera 130 .

具体实现中,工业相机130用于采集目标接口100的位置信息,控制器110获取位置信息用于调整机械臂120的位置,使连接头140与目标接口100接触。In a specific implementation, the industrial camera 130 is used to collect the position information of the target interface 100 , and the controller 110 acquires the position information to adjust the position of the robot arm 120 so that the connecting head 140 contacts the target interface 100 .

在一种可选择的实现方式中,工业相机130优选为深度相机,位置信息包括目标接口100在工业相机130坐标系中的二维平面位置信息和深度信息。请参阅图11,图11为本申请实施例提供的一种控制器获取工业相机采集的目标接口位置信息的方法流程图。如图11所示,步骤S101具体包括以下步骤:In an optional implementation manner, the industrial camera 130 is preferably a depth camera, and the position information includes two-dimensional plane position information and depth information of the target interface 100 in the coordinate system of the industrial camera 130 . Please refer to FIG. 11 . FIG. 11 is a flow chart of a method for a controller to acquire target interface position information collected by an industrial camera provided in an embodiment of the present application. As shown in Figure 11, step S101 specifically includes the following steps:

步骤S201:控制器110获取工业相机130采集的第一图像和深度信息,第一图像包含目标接口100。在本实施例中,目标接口100的位置信息为三维坐标信息,具体的,根据第一图像可获取目标接口100在工业相机坐标系中的二维平面位置信息,与工业相机130采集的深度信息结合,共同组成目标接口100的位置信息。其中,工业相机130采集的深度信息为目标接口100到工业相机130的距离。Step S201 : the controller 110 acquires a first image and depth information collected by the industrial camera 130 , the first image includes the target interface 100 . In this embodiment, the position information of the target interface 100 is three-dimensional coordinate information. Specifically, according to the first image, the two-dimensional plane position information of the target interface 100 in the industrial camera coordinate system and the depth information collected by the industrial camera 130 can be obtained. combined to form the location information of the target interface 100 . Wherein, the depth information collected by the industrial camera 130 is the distance from the target interface 100 to the industrial camera 130 .

步骤S202:控制器110将第一图像与预先存储的第二图像进行匹配,以从第一图像中获取目标接口100的轮廓。Step S202: The controller 110 matches the first image with the pre-stored second image, so as to obtain the outline of the target interface 100 from the first image.

第一图像中不仅包含目标接口100的图像,而且还可能包含电子设备上的其他接口图像,因此,第一图像需要与预先存储的第二图像进行匹配,以获取目标接口100的轮廓。其中,第二图像为预先存储的目标接口100图像。在一些实施例中,可以预先存储多张第二图像,每个第二图像对应不同的目标接口100图像,这样,可以分别对多个不同目标接口100进行连接,不仅可以增加本申请实施例提供接线方法的适用性,而且可以进一步提高接线效率。The first image not only includes the image of the target interface 100 but may also include other interface images on the electronic device. Therefore, the first image needs to be matched with the pre-stored second image to obtain the outline of the target interface 100 . Wherein, the second image is a pre-stored image of the target interface 100 . In some embodiments, a plurality of second images can be stored in advance, and each second image corresponds to a different image of the target interface 100. In this way, a plurality of different target interfaces 100 can be connected respectively, which can not only increase the The applicability of the wiring method, and can further improve the wiring efficiency.

在一种可选择的实现方式中,控制器110通过边缘检测算法从第一图像中获取目标接口100的轮廓。In an optional implementation manner, the controller 110 acquires the outline of the target interface 100 from the first image through an edge detection algorithm.

具体实现中,边缘检测算法是一种可以通过标识数字图像中亮度变化明显的点,从而提取图像中边缘的算法。因此,控制器110通过边缘检测算法可以有效的从第一图像中提取目标接口100的轮廓。具体的,边缘检测算法包括:Sobel算子检测算法,Laplacian算子检测算法和Canny算子检测算法等。本申请对边缘检测采用的具体算法不做具体限定。In a specific implementation, the edge detection algorithm is an algorithm that can extract edges in an image by identifying points with obvious brightness changes in the digital image. Therefore, the controller 110 can effectively extract the outline of the target interface 100 from the first image through the edge detection algorithm. Specifically, the edge detection algorithm includes: a Sobel operator detection algorithm, a Laplacian operator detection algorithm, a Canny operator detection algorithm, and the like. This application does not specifically limit the specific algorithm adopted by the edge detection.

步骤S203:控制器110根据轮廓确定二维平面位置信息,二维平面位置信息包括轮廓的中心点坐标。在本实施例中,以轮廓的中心点坐标表示目标接口100的二维平面位置信息。Step S203: The controller 110 determines two-dimensional plane position information according to the contour, and the two-dimensional plane position information includes the center point coordinates of the contour. In this embodiment, the two-dimensional plane position information of the target interface 100 is represented by the coordinates of the central point of the outline.

在一种可选择的实现方式中,控制器110根据一阶中心矩计算二维平面位置信息。In an optional implementation manner, the controller 110 calculates the two-dimensional plane position information according to the first-order central moment.

具体实现中,由于二维图像空间矩的实质为面积,因此可以通过一阶矩计算二维图像中某一个轮廓图形的中心点坐标。控制器110根据轮廓通过一阶中心矩计算确定二维平面位置信息,即得到轮廓的中心点坐标。轮廓的中心点坐标与深度信息结合用于目标接口100的初步定位。In a specific implementation, since the essence of the space moment of the two-dimensional image is the area, the coordinates of the center point of a certain contour figure in the two-dimensional image can be calculated through the first-order moment. The controller 110 determines the two-dimensional plane position information by calculating the first-order central moment according to the contour, that is, obtains the coordinates of the central point of the contour. The coordinates of the central point of the outline and the depth information are used for preliminary positioning of the target interface 100 .

步骤S204:控制器110根据深度信息和中心点坐标得到目标接口100在工业相机130坐标系中的三维坐标信息。步骤S102:控制器110根据位置信息,控制机械臂120,使连接头140与目标接口100接触。Step S204: The controller 110 obtains the three-dimensional coordinate information of the target interface 100 in the coordinate system of the industrial camera 130 according to the depth information and the center point coordinates. Step S102: The controller 110 controls the robot arm 120 according to the position information, so that the connecting head 140 contacts the target interface 100 .

具体实现中,控制器110根据位置信息,通过控制机械臂120调整位置,使连接头140与目标接口100进行初步定位,令连接头140与目标接口100接触,以便于控制器110对目标接口100进行精确定位,实现连接头140与目标接口100的高精度对接。In the specific implementation, the controller 110 adjusts the position by controlling the mechanical arm 120 according to the position information, so that the connector 140 and the target interface 100 are initially positioned, so that the connector 140 is in contact with the target interface 100, so that the controller 110 can adjust the position of the target interface 100. Accurate positioning is performed to realize high-precision docking between the connecting head 140 and the target interface 100 .

步骤S103:控制器110获取传感器150采集的连接头140与目标接口100之间的接触力。Step S103: The controller 110 obtains the contact force between the connector 140 and the target interface 100 collected by the sensor 150 .

具体实现中,连接头140与目标接口100接触后,在连接头140与目标接口100之间会产生接触力,该接触力可以通过传感器150采集。In a specific implementation, after the connection head 140 contacts the target interface 100 , a contact force will be generated between the connection head 140 and the target interface 100 , and the contact force can be collected by the sensor 150 .

在一种可选择的实现方式中,传感器150优选为六维力传感器,传感器150采集的接触力包括连接头140与目标接口100之间的力沿传感器150三维坐标系上各轴的分量,以及连接头140与目标接口100之间的力绕传感器150三维坐标系上各轴的力矩。In an optional implementation, the sensor 150 is preferably a six-dimensional force sensor, and the contact force collected by the sensor 150 includes the components of the force between the connector 140 and the target interface 100 along each axis of the three-dimensional coordinate system of the sensor 150, and The torque between the force between the connector 140 and the target interface 100 around each axis of the three-dimensional coordinate system of the sensor 150 .

步骤S104:控制器110判断接触力是否小于安全阈值。Step S104: The controller 110 judges whether the contact force is less than a safety threshold.

具体实现中,通过设置一个安全阈值,控制器110根据安全阈值可以判断接触力是否过大,超过安全范围。这样,可以防止连接头140与目标接口100接触后出现撞击,而导致接触力过大损坏连接头140和目标接口100结构的情况。In a specific implementation, by setting a safety threshold, the controller 110 can judge whether the contact force is too large and exceeds the safety range according to the safety threshold. In this way, it is possible to prevent the connection head 140 from colliding with the target interface 100 , resulting in damage to the structure of the connection head 140 and the target interface 100 due to excessive contact force.

需要说明的是,安全阈值根据实际的需求进行确定。为了保证连接头140与目标接口100之间接触的安全性,安全阈值的取值要大于偏差阈值。在一些实施例中,连接头140与目标接口100之间的力沿传感器150三维坐标系上各轴的分量的安全阈值优选取值范围为:10N-15N,连接头140与目标接口100之间的力绕传感器150三维坐标系上各轴的力矩的安全阈值优选取值范围为:0.1Nm-0.15Nm。当安全阈值的取值在上述优选取值范围内时,如果接触力小于该安全阈值,则可以认为连接头140与目标接口100之间的接触力安全。It should be noted that the security threshold is determined according to actual requirements. In order to ensure the safety of the contact between the connecting head 140 and the target interface 100, the value of the safety threshold should be greater than the deviation threshold. In some embodiments, the preferred safety threshold of the component of the force between the connector 140 and the target interface 100 along each axis on the three-dimensional coordinate system of the sensor 150 is: 10N-15N, between the connector 140 and the target interface 100 The preferred value range of the safety threshold of the torque of each axis on the three-dimensional coordinate system of the force-circling sensor 150 is: 0.1Nm-0.15Nm. When the value of the safety threshold is within the above preferred value range, if the contact force is smaller than the safety threshold, it can be considered that the contact force between the connector 140 and the target interface 100 is safe.

步骤S105:如果接触力大于或者等于安全阈值,控制器110控制机械臂120回退,使连接头140和目标接口100分离。Step S105: If the contact force is greater than or equal to the safety threshold, the controller 110 controls the mechanical arm 120 to retreat, so that the connecting head 140 is separated from the target interface 100 .

具体实现中,如果接触力大于或者等于安全阈值,说明连接头140与目标接口100之间的接触力较大,连接头140与目标接口100之间可能出现撞击的情况,控制器110需要及时控制机械臂120回退,使连接头140和目标接口100分离,防止连接头140或者目标接口100的结构发生损坏。机械臂120回退之后,控制器110再次获取工业相机130采集的目标接口100的位置信息,重新根据位置信息控制机械臂120,使连接头140与目标接口100接触。In a specific implementation, if the contact force is greater than or equal to the safety threshold, it means that the contact force between the connector 140 and the target interface 100 is relatively large, and there may be a collision between the connector 140 and the target interface 100, and the controller 110 needs to control it in time. The mechanical arm 120 retreats to separate the connecting head 140 from the target interface 100 to prevent damage to the structure of the connecting head 140 or the target interface 100 . After the mechanical arm 120 retreats, the controller 110 obtains the position information of the target interface 100 collected by the industrial camera 130 again, and controls the mechanical arm 120 again according to the position information, so that the connector 140 contacts the target interface 100 .

步骤S106:如果接触力小于安全阈值,控制器110判断接触力是否小于偏差阈值。Step S106: If the contact force is less than the safety threshold, the controller 110 determines whether the contact force is less than the deviation threshold.

具体实现中,如果接触力小于安全阈值,说明连接头140与目标接口100之间的接触力在安全范围内。控制器110可以进一步通过判断接触力是否小于偏差阈值,精细化调整机械臂120的位姿,将连接头14与目标接口100对准。具体的,通过比较接触力与偏差阈值的大小可以判断连接头140与目标接口100是否对准,以实现连接头140与目标接口100的高精度对接。连接头140与目标接口100是否对准可以理解为,连接头140的中轴线与目标接口100的中轴线是否重合。In a specific implementation, if the contact force is less than the safety threshold, it means that the contact force between the connecting head 140 and the target interface 100 is within a safe range. The controller 110 can further fine-tune the pose of the robotic arm 120 by judging whether the contact force is smaller than the deviation threshold, and align the connecting head 14 with the target interface 100 . Specifically, it can be judged whether the connection head 140 is aligned with the target interface 100 by comparing the contact force with the deviation threshold, so as to realize high-precision docking between the connection head 140 and the target interface 100 . Whether the connecting head 140 is aligned with the target interface 100 can be understood as whether the central axis of the connecting head 140 coincides with the central axis of the target interface 100 .

需要说明的是,偏差阈值根据实际的应用场景以及对接精度的要求进行确定。如果连接头140与样机接口100完全对齐,各个维度的接触力应该接近于零,因此,偏差阈值取值越小,连接头140与样机接口100对准的精度越高。在一些实施例中,连接头140与目标接口100之间的力沿传感器150三维坐标系上各轴的分量的偏差阈值优选取值范围为:1N-1.5N,连接头140与目标接口100之间的力绕传感器150三维坐标系上各轴的力矩的偏差阈值优选取值范围为:0.01Nm-0.015Nm。当偏差阈值的取值在上述优选取值范围内时,如果接触力小于该偏差阈值,则可以认为连接头140与目标接口100近似对准,连接头140可以与目标接口100进行对接。It should be noted that the deviation threshold is determined according to actual application scenarios and requirements for docking accuracy. If the connector 140 is perfectly aligned with the prototype interface 100 , the contact force in each dimension should be close to zero. Therefore, the smaller the deviation threshold is, the higher the alignment accuracy of the connector 140 and the prototype interface 100 will be. In some embodiments, the deviation threshold of the force between the connector 140 and the target interface 100 along each axis of the three-dimensional coordinate system of the sensor 150 is preferably in the range of 1N-1.5N, between the connector 140 and the target interface 100 The preferred value range of the torque deviation threshold of each axis on the three-dimensional coordinate system of the force around the sensor 150 is: 0.01Nm-0.015Nm. When the value of the deviation threshold is within the above preferred value range, if the contact force is smaller than the deviation threshold, it can be considered that the connector 140 is approximately aligned with the target interface 100 , and the connector 140 can be docked with the target interface 100 .

步骤S107:如果接触力大于或者等于偏差阈值,控制器110根据接触力,调整机械臂120位姿,以减小接触力。Step S107: If the contact force is greater than or equal to the deviation threshold, the controller 110 adjusts the pose of the robotic arm 120 according to the contact force to reduce the contact force.

具体实现中,如果接触力大于或者等于偏差阈值,则说明连接头140与目标接口100没有完全对准,位置还存在偏差,需要根据接触力再次调整机械臂120位姿,实现连接头140与目标接口100的精确定位。在步骤S107中,控制器110根据接触力,调整机械臂120位姿包括以下步骤:In the specific implementation, if the contact force is greater than or equal to the deviation threshold, it means that the connector 140 is not completely aligned with the target interface 100, and there is still a deviation in the position. It is necessary to adjust the posture of the mechanical arm 120 again according to the contact force to realize the connection between the connector 140 and the target. Precise positioning of the interface 100 . In step S107, the controller 110 adjusts the pose of the robotic arm 120 according to the contact force, including the following steps:

步骤S301:控制器110根据接触力计算位姿偏差。Step S301: The controller 110 calculates the pose deviation according to the contact force.

在一种可选择的实现方式中,控制器110首先获取惯性矩阵、阻尼矩阵和刚度矩阵。In an optional implementation manner, the controller 110 first obtains the inertia matrix, damping matrix and stiffness matrix.

具体实现中,机械臂120的位置与外界环境的接触力模型可以用一个二阶的“惯性-阻尼-弹簧”系统来等价表示。具体的,通过惯性矩阵、阻尼矩阵和刚度矩阵分别从惯性、阻尼和弹簧三个方面,来表示机械臂120的位置与外界环境的接触力之间的关系,因此,在根据接触力计算位姿偏差前,首先要获取惯性矩阵、阻尼矩阵和刚度矩阵。惯性矩阵、阻尼矩阵和刚度矩阵三个矩阵均为常值矩阵,三个矩阵的取值与机械臂120和外界环境有关,需要通过实验调整到合适的数值。本申请对惯性矩阵、阻尼矩阵和刚度矩阵的取值不做限定。In a specific implementation, the position of the mechanical arm 120 and the contact force model of the external environment can be equivalently represented by a second-order "inertia-damping-spring" system. Specifically, the relationship between the position of the manipulator 120 and the contact force of the external environment is expressed from the three aspects of inertia, damping and spring through the inertia matrix, damping matrix and stiffness matrix. Therefore, when calculating the pose according to the contact force Before deviation, the inertia matrix, damping matrix and stiffness matrix must be obtained first. The three matrices of inertia matrix, damping matrix and stiffness matrix are all constant value matrices. The values of the three matrices are related to the mechanical arm 120 and the external environment, and need to be adjusted to appropriate values through experiments. This application does not limit the values of the inertia matrix, damping matrix and stiffness matrix.

在一种可选择的实现方式中,接触力和位姿偏差满足以下公式:In an optional implementation, the contact force and pose deviation satisfy the following formula:

Figure BDA0003176045940000121
Figure BDA0003176045940000121

其中,F为接触力,ΔX为位姿偏差,M为惯性矩阵,B为阻尼矩阵,K为刚度矩阵;位姿偏差包括连接头沿传感器三维坐标系上各轴的平移量,以及连接头绕传感器三维坐标系上各轴的旋转角。Among them, F is the contact force, ΔX is the pose deviation, M is the inertia matrix, B is the damping matrix, and K is the stiffness matrix; the pose deviation includes the translation of the connector along each axis of the three-dimensional coordinate system of the sensor, and the rotation of the connector around The rotation angle of each axis on the sensor's three-dimensional coordinate system.

在本实施例中,在根据接触力计算位姿偏差的过程中,将上述公式①离散化,通过数值迭代求解得到位姿偏差,具体迭代过程的表达式如下:In this embodiment, in the process of calculating the pose deviation according to the contact force, the above formula ① is discretized, and the pose deviation is obtained through numerical iteration. The expression of the specific iterative process is as follows:

Figure BDA0003176045940000122
Figure BDA0003176045940000122

其中,λ为迭代周期,n为本次迭代次数。Among them, λ is the iteration cycle, and n is the number of iterations this time.

需要说明的是,传感器150采集的接触力处于传感器150的三维坐标系下,为了便于控制器110根据位姿偏差准确的调整机械臂120的位姿,需要将位姿偏差转换到用于控制机械臂位姿的坐标系下,例如,机械臂120的基坐标系或者世界坐标系下。具体的,可以首先将接触力由传感器150的三维坐标系转换到用于控制机械臂位姿的坐标系下,再根据接触力计算位姿偏差,这样获得的位姿偏差就处于用于控制机械臂位姿的坐标系下。或者,首先根据接触力计算位姿偏差,此时位姿偏差处于传感器150的三维坐标系下,然后再将位姿偏差由传感器150的三维坐标系转换到用于控制机械臂位姿的坐标系下。It should be noted that the contact force collected by the sensor 150 is in the three-dimensional coordinate system of the sensor 150. In order for the controller 110 to accurately adjust the pose of the mechanical arm 120 according to the pose deviation, it is necessary to convert the pose deviation into In the coordinate system of the arm pose, for example, in the base coordinate system or the world coordinate system of the robotic arm 120 . Specifically, the contact force can be converted from the three-dimensional coordinate system of the sensor 150 to the coordinate system used to control the pose of the manipulator, and then the pose deviation is calculated according to the contact force. In the coordinate system of the arm pose. Or, first calculate the pose deviation according to the contact force, at this time, the pose deviation is in the three-dimensional coordinate system of the sensor 150, and then convert the pose deviation from the three-dimensional coordinate system of the sensor 150 to the coordinate system used to control the pose of the manipulator Down.

步骤S302:控制器110根据位姿偏差调整机械臂120位姿,以减小接触力。Step S302: The controller 110 adjusts the pose of the robotic arm 120 according to the pose deviation to reduce the contact force.

具体实现中,根据位姿偏差调整机械臂120位姿后,再次获取传感器150采集的连接头140与目标接口100之间的接触力,直至接触力小于偏差阈值。In a specific implementation, after adjusting the pose of the robotic arm 120 according to the pose deviation, the contact force between the connector 140 and the target interface 100 collected by the sensor 150 is acquired again until the contact force is less than the deviation threshold.

需要说明的是,在控制器110根据接触力调整机械臂120位姿的过程中,为了提高连接头140与目标接口100对接的精度,控制器110可以是实时持续的获取连接头140与目标接口100之间的接触力。但是,这样会增加控制器110计算的数据量以及接线系统的能耗。为了降低接线系统的能耗,提高接线效率,控制器110可以以一定的采样频率获取接触力,或者,通过设置位姿变化阈值,当机械臂120的位姿变化大于位姿变化阈值时,控制器110获取接触力。本申请对此不做具体限定。It should be noted that, in the process of the controller 110 adjusting the pose of the robotic arm 120 according to the contact force, in order to improve the accuracy of the connection between the connector 140 and the target interface 100, the controller 110 can continuously obtain the connection between the connector 140 and the target interface in real time. Contact force between 100. However, this will increase the amount of data calculated by the controller 110 and the power consumption of the wiring system. In order to reduce the energy consumption of the wiring system and improve the wiring efficiency, the controller 110 can obtain the contact force at a certain sampling frequency, or, by setting the pose change threshold, when the pose change of the mechanical arm 120 is greater than the pose change threshold, control The device 110 captures the contact force. This application does not specifically limit it.

步骤S108:如果接触力小于偏差阈值,控制器110控制机械臂120,使连接头140插入到目标接口100中。Step S108: If the contact force is less than the deviation threshold, the controller 110 controls the mechanical arm 120 to insert the connector 140 into the target interface 100 .

具体实现中,如果接触力小于偏差阈值,则说明连接头140与目标接口100已经对准,控制器110可以控制机械臂120,使连接头140插入目标接口100中。In a specific implementation, if the contact force is less than the deviation threshold, it means that the connector 140 has been aligned with the target interface 100 , and the controller 110 can control the mechanical arm 120 to insert the connector 140 into the target interface 100 .

本申请实施例提供的接线方法,控制器110首先获取工业相机130采集的目标接口100的位置信息,根据位置信息对目标接口100进行初步定位,通过控制机械臂120,使连接头140与目标接口100接触。然后,控制器110获取传感器150采集的连接头140与目标接口100之间的接触力,根据接触力对目标接口100进行精确定位,通过调整机械臂120位姿,以减小接触力。最后,当接触力小于偏差阈值时,控制器110控制机械臂120,使连接头140插入到目标接口100中,以实现连接头140与目标接口100的高精度对接。由此可见,本申请提供的技术方案,通过控制器110控制机械臂120,结合工业相机130和传感器150,可以快速实现连接头140与目标接口100的高精度对接,从而提高电子设备调试效率。In the wiring method provided in the embodiment of the present application, the controller 110 first obtains the position information of the target interface 100 collected by the industrial camera 130, performs preliminary positioning on the target interface 100 according to the position information, and controls the mechanical arm 120 to make the connector 140 and the target interface 100 contacts. Then, the controller 110 acquires the contact force between the connector 140 and the target interface 100 collected by the sensor 150 , accurately positions the target interface 100 according to the contact force, and adjusts the pose of the robotic arm 120 to reduce the contact force. Finally, when the contact force is less than the deviation threshold, the controller 110 controls the robotic arm 120 to insert the connector 140 into the target interface 100 , so as to achieve high-precision docking between the connector 140 and the target interface 100 . It can be seen that in the technical solution provided by the present application, the robot arm 120 is controlled by the controller 110, combined with the industrial camera 130 and the sensor 150, the high-precision docking between the connector 140 and the target interface 100 can be quickly realized, thereby improving the debugging efficiency of electronic equipment.

本申请实施例还提供一种计算机存储介质,计算机存储介质中存储有计算机指令,当其在计算机上运行时,使得计算机执行上述各方面的方法。The embodiment of the present application also provides a computer storage medium, in which computer instructions are stored, and when the computer is run on the computer, the computer is made to execute the above methods.

本申请实施例还提供一种包含指令的计算机程序产品,当其在计算机上运行时,使得计算机执行上述各方面的方法。The embodiment of the present application also provides a computer program product including instructions, which, when running on a computer, causes the computer to execute the methods in the above aspects.

本申请还提供了一种芯片系统。该芯片系统包括处理器,用于支持上述装置或设备实现上述方面中所涉及的功能,例如,生成或处理上述方法中所涉及的信息。在一种可能的设计中,芯片系统还包括存储器,用于保存上述模块或设备必要的程序指令和数据。该芯片系统,可以由芯片构成,也可以包含芯片和其他分立器件。The present application also provides a chip system. The system-on-a-chip includes a processor, configured to support the above-mentioned device or device to implement the functions involved in the above-mentioned aspect, for example, generate or process the information involved in the above-mentioned method. In a possible design, the chip system further includes a memory for storing necessary program instructions and data of the above-mentioned modules or devices. The system-on-a-chip may consist of chips, or may include chips and other discrete devices.

以上的具体实施方式,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上仅为本发明的具体实施方式而已,并不用于限定本发明的保护范围,凡在本发明的技术方案的基础之上,所做的任何修改、等同替换、改进等,均应包括在本发明的保护范围之内。The above specific implementation manners have further described the purpose, technical solutions and beneficial effects of the present invention in detail. It should be understood that the above are only specific implementation modes of the present invention, and are not used to limit the protection scope of the present invention. On the basis of the technical solution of the present invention, any modification, equivalent replacement, improvement, etc. should be included in the protection scope of the present invention.

以上所述的本申请实施方式并不构成对本申请保护范围的限定。The embodiments of the present application described above are not intended to limit the scope of protection of the present application.

Claims (14)

1. A wiring method characterized by being applied to a wiring system, the wiring system comprising a controller, a mechanical arm, an industrial camera, a sensor and a plurality of connectors, each of the connectors corresponding to interfaces of different shapes, the industrial camera, the plurality of connectors and the sensor being disposed at the end of the mechanical arm, the sensor being located between the mechanical arm and the plurality of connectors, the controller being coupled to the mechanical arm, the industrial camera, the plurality of connectors and the sensor;
the method comprises the following steps:
the controller acquires the position information of a target interface acquired by the industrial camera;
the controller controls the mechanical arm according to the position information to enable a target connector to be in contact with the target interface, wherein the target connector is a connector corresponding to the target interface in the connectors;
the controller acquires the contact force between the target connector and the target interface at a preset sampling frequency, or acquires the contact force between the target connector and the target interface when the pose change of the mechanical arm is greater than a pose change threshold; wherein the contact force is collected by the sensor;
The controller judges whether the contact force is smaller than a safety threshold value;
if the contact force is greater than or equal to the safety threshold, the controller controls the mechanical arm to retract so as to separate the target connector from the target interface;
if the contact force is less than the safety threshold, the controller judges whether the contact force is less than a deviation threshold;
if the contact force is greater than or equal to the deviation threshold, the controller calculates pose deviation according to the contact force;
the controller adjusts the pose of the mechanical arm according to the pose deviation so as to reduce the contact force;
when the contact force is smaller than a deviation threshold value, the controller controls the mechanical arm to enable the target connector to be inserted into the target interface;
after the target connector is inserted into the target interface, the target connector is used for realizing transmission of debugging data.
2. The method of claim 1, wherein the contact force comprises a component of a force between the target connector and the target interface along axes on the sensor three-dimensional coordinate system, and a moment of the force between the target connector and the target interface about axes on the sensor three-dimensional coordinate system.
3. The method of claim 1, wherein the controller further comprises, prior to calculating the pose bias from the contact force: the controller obtains an inertia matrix, a damping matrix and a stiffness matrix.
4. A method according to any one of claims 1-3, characterized in that the contact force and the pose deviation satisfy the following formula:
Figure QLYQS_1
wherein,,Fdelta as contact forceXFor the deviation of the pose,Mis a matrix of inertia which is a matrix of inertia,Bin order to provide a damping matrix,Kis a rigidity matrix; the pose deviation comprises translation amounts of the target connector along all axes on the three-dimensional coordinate system of the sensor and rotation angles of the target connector around all axes on the three-dimensional coordinate system of the sensor.
5. The method of claim 1, wherein the location information comprises two-dimensional planar location information and depth information of the target interface in the industrial camera coordinate system;
the controller obtains the position information of the target interface acquired by the industrial camera, and the method comprises the following steps:
the controller acquires a first image acquired by the industrial camera and the depth information, wherein the first image comprises the target interface;
the controller matches the first image with a pre-stored second image to acquire the outline of the target interface from the first image;
The controller determines the two-dimensional plane position information according to the outline, wherein the two-dimensional plane position information comprises the center point coordinates of the outline;
and the controller obtains three-dimensional coordinate information of the target interface in the industrial camera coordinate system according to the depth information and the center point coordinate.
6. The method of claim 5, wherein the controller matching the first image with a pre-stored second image to obtain the outline of the target interface from the first image comprises:
the controller acquires the outline of the target interface from the first image through an edge detection algorithm.
7. The method of claim 5 or 6, wherein the controller determining the two-dimensional plane position information from the profile comprises: the controller calculates the two-dimensional plane position information according to the first-order central moment.
8. A wiring system comprising a controller, a robotic arm, an industrial camera, a sensor, and a plurality of connectors, each of the connectors corresponding to a different shape of interface, the industrial camera, the plurality of connectors, and the sensor disposed at an end of the robotic arm, the sensor located between the robotic arm and the plurality of connectors, the controller coupled to the robotic arm, the industrial camera, the plurality of connectors, and the sensor; wherein,,
The industrial camera is used for collecting the position information of the target interface;
the controller is used for acquiring the position information, controlling the mechanical arm according to the position information, and enabling a target connector to be in contact with the target interface, wherein the target connector is a connector corresponding to the target interface in the connectors;
the sensor is used for collecting the contact force between the target connector and the target interface;
the controller is further used for acquiring the contact force at a preset sampling frequency; or when the pose change of the mechanical arm is larger than a pose change threshold value, acquiring the contact force;
the controller is further used for judging whether the contact force is smaller than a safety threshold value;
if the contact force is greater than or equal to the safety threshold, controlling the mechanical arm to retract so as to separate the target connector from the target interface;
the controller is further configured to determine whether the contact force is less than a deviation threshold if the contact force is less than the safety threshold;
if the contact force is greater than or equal to the deviation threshold, calculating pose deviation according to the contact force;
adjusting the pose of the mechanical arm according to the pose deviation so as to reduce the contact force;
The controller is further configured to control the mechanical arm to insert the target connector into the target interface when the contact force is less than a deviation threshold;
after the target connector is inserted into the target interface, the target connector is used for realizing transmission of debugging data.
9. The system of claim 8, wherein the contact force comprises a component of a force between the target connector and the target interface along axes on the sensor three-dimensional coordinate system, and a moment of the force between the target connector and the target interface about axes on the sensor three-dimensional coordinate system.
10. The system of claim 8, wherein the controller is further configured to obtain an inertia matrix, a damping matrix, and a stiffness matrix.
11. The system of any one of claims 8-10, wherein the contact force and the pose bias satisfy the following formulas:
Figure QLYQS_2
wherein,,Fdelta as contact forceXFor the deviation of the pose,Mis a matrix of inertia which is a matrix of inertia,Bin order to provide a damping matrix,Kis a rigidity matrix;
the pose deviation comprises translation amounts of the target connector along all axes on the three-dimensional coordinate system of the sensor and rotation angles of the target connector around all axes on the three-dimensional coordinate system of the sensor.
12. The system of claim 8, wherein the location information comprises two-dimensional planar location information and depth information of the target interface in the industrial camera coordinate system; the controller is further configured to:
acquiring a first image acquired by the industrial camera and the depth information, wherein the first image comprises the target interface;
matching the first image with a pre-stored second image to acquire the outline of the target interface from the first image;
determining the two-dimensional plane position information according to the contour, wherein the two-dimensional plane position information comprises the center point coordinates of the contour;
and obtaining three-dimensional coordinate information of the target interface in the industrial camera coordinate system according to the depth information and the center point coordinate.
13. The system of claim 12, wherein the controller is further configured to obtain the contour of the target interface from the first image via an edge detection algorithm.
14. The system of claim 12 or 13, wherein the controller is further configured to calculate the two-dimensional planar location information based on a first order central moment.
CN202110832521.3A 2021-07-22 2021-07-22 A wiring method and system Active CN114441807B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110832521.3A CN114441807B (en) 2021-07-22 2021-07-22 A wiring method and system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110832521.3A CN114441807B (en) 2021-07-22 2021-07-22 A wiring method and system

Publications (2)

Publication Number Publication Date
CN114441807A CN114441807A (en) 2022-05-06
CN114441807B true CN114441807B (en) 2023-07-07

Family

ID=81362756

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110832521.3A Active CN114441807B (en) 2021-07-22 2021-07-22 A wiring method and system

Country Status (1)

Country Link
CN (1) CN114441807B (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117226851B (en) * 2023-11-10 2024-01-30 拓锐科技有限公司 Intelligent robot operation management system based on electric power site

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010023184A (en) * 2008-07-18 2010-02-04 Fanuc Ltd Setting method for working coordinate system, and abnormality detection device for working coordinate system
CN106041926A (en) * 2016-06-12 2016-10-26 哈尔滨工程大学 Industrial mechanical arm force/position mixed control method based on Kalman filter
CN109895645A (en) * 2019-03-29 2019-06-18 南京理工大学 A kind of new-energy automobile automatic charging system
CN111098309A (en) * 2020-01-06 2020-05-05 江南大学 A kind of mechanical arm hybrid control method, device and system
CN112060085A (en) * 2020-08-24 2020-12-11 清华大学 Robot operation pose control method based on visual-touch multi-scale positioning
WO2021012122A1 (en) * 2019-07-19 2021-01-28 西门子(中国)有限公司 Robot hand-eye calibration method and apparatus, computing device, medium and product

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH079608B2 (en) * 1984-06-22 1995-02-01 株式会社日立製作所 Robot control method and apparatus
US8918213B2 (en) * 2010-05-20 2014-12-23 Irobot Corporation Mobile human interface robot
DE102013218823A1 (en) * 2013-09-19 2015-04-02 Kuka Laboratories Gmbh Method for manually adjusting the pose of a manipulator arm of an industrial robot and associated industrial robots
CN106112505B (en) * 2016-07-04 2018-07-24 清华大学 Double-shaft-and-hole assembly system and its control method
CN106272424B (en) * 2016-09-07 2017-10-27 华中科技大学 A kind of industrial robot grasping means based on monocular camera and three-dimensional force sensor
CN107618396B (en) * 2017-10-19 2023-11-07 环球车享汽车租赁有限公司 Automatic charging system and method
CN110919654B (en) * 2019-12-02 2021-04-30 中国船舶工业系统工程研究院 Automatic airplane butt joint method based on visual servo and mechanical arm
CN110977985B (en) * 2019-12-23 2021-10-01 中国银联股份有限公司 Positioning method and device
CN110900581B (en) * 2019-12-27 2023-12-22 福州大学 Four-degree-of-freedom mechanical arm vision servo control method and device based on RealSense camera
CN111331604A (en) * 2020-03-23 2020-06-26 北京邮电大学 A machine vision-based valve screwing and compliant operation method
CN112578152A (en) * 2020-12-08 2021-03-30 创维集团智能装备有限公司 Method, system and assembly for improving wire plugging and unplugging efficiency of signal wire
CN112720476A (en) * 2020-12-22 2021-04-30 北京天智航医疗科技股份有限公司 Mechanical arm control method, mechanical arm control device, medium and electronic equipment

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010023184A (en) * 2008-07-18 2010-02-04 Fanuc Ltd Setting method for working coordinate system, and abnormality detection device for working coordinate system
CN106041926A (en) * 2016-06-12 2016-10-26 哈尔滨工程大学 Industrial mechanical arm force/position mixed control method based on Kalman filter
CN109895645A (en) * 2019-03-29 2019-06-18 南京理工大学 A kind of new-energy automobile automatic charging system
WO2021012122A1 (en) * 2019-07-19 2021-01-28 西门子(中国)有限公司 Robot hand-eye calibration method and apparatus, computing device, medium and product
CN111098309A (en) * 2020-01-06 2020-05-05 江南大学 A kind of mechanical arm hybrid control method, device and system
CN112060085A (en) * 2020-08-24 2020-12-11 清华大学 Robot operation pose control method based on visual-touch multi-scale positioning

Also Published As

Publication number Publication date
CN114441807A (en) 2022-05-06

Similar Documents

Publication Publication Date Title
Jiang et al. A measurement method for robot peg-in-hole prealignment based on combined two-level visual sensors
US11833692B2 (en) Method and device for controlling arm of robot
US10894315B2 (en) Robot controller and robot system
CN116278880A (en) Charging equipment and method for controlling mechanical arm to charge
CN114441807B (en) A wiring method and system
CN112621743B (en) Robot, hand-eye calibration method for fixing camera at tail end of robot and storage medium
CN113814987B (en) Multi-camera robot hand-eye calibration method, device, electronic device and storage medium
CN110967350A (en) Chip testing method and device based on image recognition and electronic equipment
CN111113428A (en) Robot control method, robot control device and terminal equipment
CN105513128A (en) Kinect-based three-dimensional data fusion processing method
CN116802582A (en) Robust docking of incomplete sensing robots
CN113814951A (en) Control method, system and storage medium for master-slave robot
CN113246145B (en) Pose compensation method and system for nuclear industry grabbing equipment and electronic device
WO2025060849A1 (en) System apparatus and registration method for omnidirectional measurement device, electronic device, and storage medium
US11325247B2 (en) Robotic arm control method and apparatus and terminal device using the same
CN113601510A (en) Robot movement control method, device, system and equipment based on binocular vision
CN109596869B (en) Power distribution terminal on-line detection device and method based on visual guidance
CN118636157A (en) A hand-eye calibration method for line laser camera and robot flange
WO2018196221A1 (en) Interaction method, device and system
CN207124680U (en) A kind of external camera assembly
CN115641383A (en) Calibration method, calibration device, robot and computer readable storage medium
CN114939867A (en) Calibration method and system for mechanical arm external irregular asymmetric tool based on stereoscopic vision
CN109108975A (en) A kind of 6 axis robot of binocular vision guidance system
CN208223503U (en) A kind of wireless transmission method spherical motor relative coordinate detection device
CN213661804U (en) A mobile image acquisition and projection device

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CP03 Change of name, title or address

Address after: Unit 3401, unit a, building 6, Shenye Zhongcheng, No. 8089, Hongli West Road, Donghai community, Xiangmihu street, Futian District, Shenzhen, Guangdong 518040

Patentee after: Honor Terminal Co.,Ltd.

Country or region after: China

Address before: 3401, unit a, building 6, Shenye Zhongcheng, No. 8089, Hongli West Road, Donghai community, Xiangmihu street, Futian District, Shenzhen, Guangdong

Patentee before: Honor Device Co.,Ltd.

Country or region before: China

CP03 Change of name, title or address