CN114441807B - A wiring method and system - Google Patents
A wiring method and system Download PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 38
- 239000011159 matrix material Substances 0.000 claims description 68
- 238000013016 damping Methods 0.000 claims description 24
- 238000003708 edge detection Methods 0.000 claims description 14
- 230000008859 change Effects 0.000 claims description 12
- 230000005540 biological transmission Effects 0.000 claims description 8
- 238000013519 translation Methods 0.000 claims description 7
- 238000005070 sampling Methods 0.000 claims description 4
- 238000003032 molecular docking Methods 0.000 abstract description 14
- 238000010586 diagram Methods 0.000 description 18
- 238000001514 detection method Methods 0.000 description 6
- 230000006870 function Effects 0.000 description 6
- 230000008569 process Effects 0.000 description 6
- 238000012545 processing Methods 0.000 description 5
- 238000012423 maintenance Methods 0.000 description 4
- 238000013461 design Methods 0.000 description 3
- 238000009434 installation Methods 0.000 description 3
- 239000000758 substrate Substances 0.000 description 3
- 238000013528 artificial neural network Methods 0.000 description 2
- 238000005265 energy consumption Methods 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 238000012804 iterative process Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 230000003190 augmentative effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000011056 performance test Methods 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01R—MEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
- G01R1/00—Details of instruments or arrangements of the types included in groups G01R5/00 - G01R13/00 and G01R31/00
- G01R1/02—General constructional details
- G01R1/04—Housings; Supporting members; Arrangements of terminals
- G01R1/0408—Test fixtures or contact fields; Connectors or connecting adaptors; Test clips; Test sockets
- G01R1/0416—Connectors, terminals
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/02—Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
- B25J9/04—Programme-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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1679—Programme controls characterised by the tasks executed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1694—Programme 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/1697—Vision controlled systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01R—MEASURING ELECTRIC VARIABLES; MEASURING MAGNETIC VARIABLES
- G01R1/00—Details of instruments or arrangements of the types included in groups G01R5/00 - G01R13/00 and G01R31/00
- G01R1/02—General constructional details
- G01R1/04—Housings; Supporting members; Arrangements of terminals
- G01R1/0408—Test fixtures or contact fields; Connectors or connecting adaptors; Test clips; Test sockets
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total 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
本申请提供一种接线方法及系统。所述接线系统包括控制器、机械臂以及设置在机械臂末端的工业相机、连接头和传感器。所述方法包括:控制器获取工业相机采集的目标接口的位置信息;控制器根据位置信息,控制机械臂,使连接头与目标接口接触;控制器获取传感器采集的连接头与目标接口之间的接触力;控制器根据接触力,调整机械臂位姿,以减小接触力;控制器在接触力小于偏差阈值时,控制机械臂,使连接头插入到目标接口中。由此可见,本申请提供的技术方案中,控制器根据工业相机采集的目标接口的位置信息,以及传感器采集的接触力,调整机械臂的位姿,可以快速实现连接头与目标接口的高精度对接,从而提高电子设备调试效率。
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.
Description
技术领域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:
其中,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:
其中,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
示例地,在对电子设备进行充电调试时,调试人员需要将充电调试数据线与电子设备的充电接口连接。请参阅图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
在实际的工作中,调试人员在对电子设备进行性能调试时,首先需要将待测电子设备放置于操作台,然后根据性能调试的需求选择对应连接头的调试数据线,最后通过肉眼观察电子设备的外部结构,找到性能调试需要连接的接口,手动将调试数据线插入接口。这一过程需要消耗较长的时间,导致电子设备调试效率很低。在大量的电子设备进行性能调试的情况下,如果每一台电子设备都通过调试人员人工对不同接口进行接线,将会大幅降低整个生产线或者维修线的调试效率,影响电子设备的交付速度。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
目标接口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
下面结合附图,对本申请提供的接线系统进行详细说明。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
请参阅图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
在本实施例中,连接头140固定在传感器150上,以便于传感器150获取连接头140的受力情况。图5为本申请实施例提供的一种连接头和传感器的结构示意图。如图5所示,可选的,在传感器150上可以设置有多个连接头140,每一个连接头140对应一种不同的形状的接口。这样,在对电子设备进行多项性能测试,需要分别连接不同形状接口的情况下,无需更换连接头140,只需要切换到与接口形状对应的连接头140,就可以实现与不同形状接口的连线,进一步提高了本申请提供的接线系统的适用性。In this embodiment, the
在本实施例中,控制器110与机械臂120、工业相机130、连接头140和传感器150耦合。具体的,控制器110与机械臂120、工业相机130、连接头140和传感器150之间可以通过数据线有线连接,或者,通过无线通信模块进行无线连接,例如无线保真(wirelessfidelity,Wi-Fi)、蓝牙bluetooth、蓝牙网状网络(蓝牙mesh)等。In this embodiment, the
本申请实施例中的控制器110用于获取工业相机130采集的目标接口100的位置信息;根据位置信息,控制机械臂120,使连接头140与目标接口100接触;获取传感器150采集的连接头140与目标接口100之间的接触力;根据接触力,调整机械臂120位姿,以减小接触力;在接触力小于偏差阈值时,控制机械臂120,使连接头140插入到目标接口100中。The
在本实施例中,请参阅图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
由此可见,本申请提供的接线系统,通过控制器110控制机械臂120,结合工业相机130和传感器150,可以快速实现连接头140与目标接口100的高精度对接,从而提高电子设备调试效率。It can be seen that the wiring system provided by the present application controls the
需要说明的是,在控制器110根据接触力调整机械臂120位姿的过程中,为了提高连接头140与目标接口100对接的精度,控制器110可以是实时持续的获取连接头140与目标接口100之间的接触力。但是,这样会增加控制器110计算的数据量以及接线系统的能耗。为了降低接线系统的能耗,提高接线效率,控制器110可以以一定的采样频率获取接触力,或者,通过设置位姿变化阈值,当机械臂120的位姿变化大于位姿变化阈值时,控制器110获取接触力。本申请对此不做具体限定。It should be noted that, in the process of the
在本实施例中,控制器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
本申请实施例中的机械臂120用于根据控制器110的控制指令调整位置和姿态,使连接头140准确的插入到目标接口100中。其中,机械臂120是一种能够接受指令,精确地定位到三维或二维空间上的某一点进行作业的自动化机械装置。机械臂根据结构形式的不同分为多关节机械臂,直角坐标系机械臂,球坐标系机械臂,极坐标机械臂,柱坐标机械臂等。在本实施例中机械臂120优选为一种可以实现六自由度运动的多关节机械手臂,即机械臂120可以实现沿其三维坐标系的X轴、Y轴和Z轴的移动和旋转。通过控制机械臂120在六个自由度上的运动,可以调整机械臂120的位置和姿态,从而改变设置在机械臂120末端的连接头140的位置,实现将连接头140插入目标接口100中。The
本申请实施例中的工业相机130用于采集目标接口100的位置信息。工业相机130是一种将光信号转变成有序电信号的摄像机,具有高的图像稳定性、高传输能力和高抗干扰能力等优势。在一种可选择的实现方式中,工业相机130优选为深度相机,工业相机130采集的位置信息包括目标接口100在工业相机130坐标系中的二维平面位置信息和深度信息。深度相机不仅具有拍摄物体图像的功能,而且具有深度测量功能。通过深度相机获取到的数据,可以准确的获得图像中每个点到深度相机摄像头的距离,结合该点在二维图像中的坐标值,就可以获取图像中每个点的三维坐标值。具体的,工业相机130可以是结构光(structured-light)深度相机、双目立体视觉(binocular stereo vision)深度相机和光飞行时间(time of flight,TOF)深度相机等,本申请不做具体限定。The
本申请实施例中的连接头140用于与目标接口100连接,实现数据传输。例如,连接头140可以是天线射频(radio-frequency)连接头,Micro USB连接头,USB Type C连接头和Lightning连接头等。可以理解的是,连接头140与数据线连接,以实现调试数据的传输。在本实施例中,连接头140的结构与目标接口100的结构相匹配,使连接头140插入目标接口100后不会破坏目标接口100的结构,并且连接头140可以实现传输数据的功能。The
本申请实施例中的传感器150用于采集连接头140与目标接口100之间的接触力。具体的,传感器150是一种力传感器,可以将力的量值转换为相关电信号。在一种可选择的实现方式中,传感器150优选为六维力传感器,六维力传感器是一种能够同时测量X轴、Y轴和Z轴三个方向的力与力矩的传感器。在本实施例中,传感器150采集的接触力包括连接头140与目标接口100之间的力沿传感器150三维坐标系上各轴的分量,以及连接头140与目标接口100之间的力绕传感器150三维坐标系上各轴的力矩。The
在一种可选择的实现方式中,控制器110还用于:判断接触力是否小于偏差阈值;如果接触力大于或者等于偏差阈值,根据接触力计算位姿偏差;根据位姿偏差调整机械臂120位姿,以减小接触力。In an optional implementation, the
在本实施例中,控制器110通过比较接触力与偏差阈值的大小,可以判断连接头140与目标接口100是否对准,以实现连接头140与目标接口100的高精度对接。其中,连接头140与目标接口100是否对准可以理解为,连接头140的中轴线与目标接口100的中轴线是否重合。如果接触力小于偏差阈值,则说明连接头140与目标接口100已经对准,可以将连接头140插入目标接口100中。如果接触力大于或者等于偏差阈值,则说明连接头140与目标接口100没有对准,位置还存在偏差,需要根据接触力计算位姿偏差,根据位姿偏差调整机械臂120位姿,再次获取传感器150采集的连接头140与目标接口100之间的接触力,直至接触力小于偏差阈值。In this embodiment, the
需要说明的是,偏差阈值根据实际的应用场景以及对接精度的要求进行确定。如果连接头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
在一种可选择的实现方式中,在控制器110根据接触力计算位姿偏差之前,控制器110,还用于获取惯性矩阵、阻尼矩阵和刚度矩阵。在本实施例中,机械臂120的位置与外界环境的接触力模型可以用一个二阶的“惯性-阻尼-弹簧”系统来等价表示。具体的,通过惯性矩阵、阻尼矩阵和刚度矩阵分别从惯性、阻尼和弹簧三个方面,来表示机械臂120的位置与外界环境的接触力之间的关系,因此,在根据接触力计算位姿偏差前,首先要获取惯性矩阵、阻尼矩阵和刚度矩阵。惯性矩阵、阻尼矩阵和刚度矩阵三个矩阵均为常值矩阵,三个矩阵的取值与机械臂120和外界环境有关,需要通过实验调整到合适的数值。本申请对惯性矩阵、阻尼矩阵和刚度矩阵的取值不做限定。In an optional implementation manner, before the
在一种可选择的实现方式中,接触力和位姿偏差满足以下公式:In an optional implementation, the contact force and pose deviation satisfy the following formula:
其中,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:
其中,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
ΔX展开后的表达式为:The expanded expression of ΔX is:
其中,Δ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
在本实施例中,在根据接触力计算位姿偏差的过程中,将上述公式①离散化,通过数值迭代求解可以得到位姿偏差,具体迭代过程的表达式如下: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:
其中,λ为迭代周期,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
在一种可选择的实现方式中,在判断接触力是否小于偏差阈值之前,控制器110,还用于:判断接触力是否小于安全阈值;如果接触力大于或者等于安全阈值,控制机械臂120回退,使连接头140和目标接口100分离。In an optional implementation, before judging whether the contact force is less than the deviation threshold, the
在本实施例中,在控制器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
需要说明的是,安全阈值根据实际的需求进行确定。为了保证连接头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
在一种可选择的实现方式中,位置信息包括目标接口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
在本实施例中,请参阅图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
在一些实施例中,在接线系统对目标接口100进行接线前,可以预先存储多张第二图像,每个第二图像对应不同的目标接口100图像,需要说明的是,此时接线系统中也包括多个与目标接口100对应的连接头140。根据工业相机130采集的第一图像可以依次匹配出第二图像对应的目标接口100,并选择与目标接口100对应的连接头140进行连接。这样,不仅可以增加本申请实施例提供接线系统的适配性,而且可以进一步提高接线效率。In some embodiments, before the wiring system connects the
在一种可选择的实现方式中,控制器110,还用于通过边缘检测算法从第一图像中获取目标接口100的轮廓。边缘检测算法是一种可以通过标识数字图像中亮度变化明显的点,从而提取图像中边缘的算法。因此,控制器110通过边缘检测算法可以有效的从第一图像中提取目标接口100的轮廓。具体的,边缘检测算法包括:Sobel算子检测算法,Laplacian算子检测算法和Canny算子检测算法等。本申请对边缘检测采用的具体算法不做具体限定。In an optional implementation manner, the
在一种可选择的实现方式中,控制器110,还用于根据一阶中心矩计算二维平面位置信息。在本实施例中,由于二维图像空间矩的实质为面积,因此可以通过一阶矩计算二维图像中某一个轮廓图形的中心点坐标。控制器110根据轮廓通过一阶中心矩计算确定二维平面位置信息,即得到轮廓的中心点坐标。轮廓的中心点坐标用于目标接口100的初步定位,控制器110根据轮廓的中心点坐标,控制机械臂120,使连接头140与目标接口100接触。In an optional implementation manner, the
本申请实施例还提供了一种接线方法,该方法可以应用于本申请实施例提供的任一接线系统中。请参阅图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
具体实现中,工业相机130用于采集目标接口100的位置信息,控制器110获取位置信息用于调整机械臂120的位置,使连接头140与目标接口100接触。In a specific implementation, the
在一种可选择的实现方式中,工业相机130优选为深度相机,位置信息包括目标接口100在工业相机130坐标系中的二维平面位置信息和深度信息。请参阅图11,图11为本申请实施例提供的一种控制器获取工业相机采集的目标接口位置信息的方法流程图。如图11所示,步骤S101具体包括以下步骤:In an optional implementation manner, the
步骤S201:控制器110获取工业相机130采集的第一图像和深度信息,第一图像包含目标接口100。在本实施例中,目标接口100的位置信息为三维坐标信息,具体的,根据第一图像可获取目标接口100在工业相机坐标系中的二维平面位置信息,与工业相机130采集的深度信息结合,共同组成目标接口100的位置信息。其中,工业相机130采集的深度信息为目标接口100到工业相机130的距离。Step S201 : the
步骤S202:控制器110将第一图像与预先存储的第二图像进行匹配,以从第一图像中获取目标接口100的轮廓。Step S202: The
第一图像中不仅包含目标接口100的图像,而且还可能包含电子设备上的其他接口图像,因此,第一图像需要与预先存储的第二图像进行匹配,以获取目标接口100的轮廓。其中,第二图像为预先存储的目标接口100图像。在一些实施例中,可以预先存储多张第二图像,每个第二图像对应不同的目标接口100图像,这样,可以分别对多个不同目标接口100进行连接,不仅可以增加本申请实施例提供接线方法的适用性,而且可以进一步提高接线效率。The first image not only includes the image of the
在一种可选择的实现方式中,控制器110通过边缘检测算法从第一图像中获取目标接口100的轮廓。In an optional implementation manner, the
具体实现中,边缘检测算法是一种可以通过标识数字图像中亮度变化明显的点,从而提取图像中边缘的算法。因此,控制器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
步骤S203:控制器110根据轮廓确定二维平面位置信息,二维平面位置信息包括轮廓的中心点坐标。在本实施例中,以轮廓的中心点坐标表示目标接口100的二维平面位置信息。Step S203: The
在一种可选择的实现方式中,控制器110根据一阶中心矩计算二维平面位置信息。In an optional implementation manner, the
具体实现中,由于二维图像空间矩的实质为面积,因此可以通过一阶矩计算二维图像中某一个轮廓图形的中心点坐标。控制器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
步骤S204:控制器110根据深度信息和中心点坐标得到目标接口100在工业相机130坐标系中的三维坐标信息。步骤S102:控制器110根据位置信息,控制机械臂120,使连接头140与目标接口100接触。Step S204: The
具体实现中,控制器110根据位置信息,通过控制机械臂120调整位置,使连接头140与目标接口100进行初步定位,令连接头140与目标接口100接触,以便于控制器110对目标接口100进行精确定位,实现连接头140与目标接口100的高精度对接。In the specific implementation, the
步骤S103:控制器110获取传感器150采集的连接头140与目标接口100之间的接触力。Step S103: The
具体实现中,连接头140与目标接口100接触后,在连接头140与目标接口100之间会产生接触力,该接触力可以通过传感器150采集。In a specific implementation, after the
在一种可选择的实现方式中,传感器150优选为六维力传感器,传感器150采集的接触力包括连接头140与目标接口100之间的力沿传感器150三维坐标系上各轴的分量,以及连接头140与目标接口100之间的力绕传感器150三维坐标系上各轴的力矩。In an optional implementation, the
步骤S104:控制器110判断接触力是否小于安全阈值。Step S104: The
具体实现中,通过设置一个安全阈值,控制器110根据安全阈值可以判断接触力是否过大,超过安全范围。这样,可以防止连接头140与目标接口100接触后出现撞击,而导致接触力过大损坏连接头140和目标接口100结构的情况。In a specific implementation, by setting a safety threshold, the
需要说明的是,安全阈值根据实际的需求进行确定。为了保证连接头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
步骤S105:如果接触力大于或者等于安全阈值,控制器110控制机械臂120回退,使连接头140和目标接口100分离。Step S105: If the contact force is greater than or equal to the safety threshold, the
具体实现中,如果接触力大于或者等于安全阈值,说明连接头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
步骤S106:如果接触力小于安全阈值,控制器110判断接触力是否小于偏差阈值。Step S106: If the contact force is less than the safety threshold, the
具体实现中,如果接触力小于安全阈值,说明连接头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
需要说明的是,偏差阈值根据实际的应用场景以及对接精度的要求进行确定。如果连接头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
步骤S107:如果接触力大于或者等于偏差阈值,控制器110根据接触力,调整机械臂120位姿,以减小接触力。Step S107: If the contact force is greater than or equal to the deviation threshold, the
具体实现中,如果接触力大于或者等于偏差阈值,则说明连接头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
步骤S301:控制器110根据接触力计算位姿偏差。Step S301: The
在一种可选择的实现方式中,控制器110首先获取惯性矩阵、阻尼矩阵和刚度矩阵。In an optional implementation manner, the
具体实现中,机械臂120的位置与外界环境的接触力模型可以用一个二阶的“惯性-阻尼-弹簧”系统来等价表示。具体的,通过惯性矩阵、阻尼矩阵和刚度矩阵分别从惯性、阻尼和弹簧三个方面,来表示机械臂120的位置与外界环境的接触力之间的关系,因此,在根据接触力计算位姿偏差前,首先要获取惯性矩阵、阻尼矩阵和刚度矩阵。惯性矩阵、阻尼矩阵和刚度矩阵三个矩阵均为常值矩阵,三个矩阵的取值与机械臂120和外界环境有关,需要通过实验调整到合适的数值。本申请对惯性矩阵、阻尼矩阵和刚度矩阵的取值不做限定。In a specific implementation, the position of the
在一种可选择的实现方式中,接触力和位姿偏差满足以下公式:In an optional implementation, the contact force and pose deviation satisfy the following formula:
其中,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:
其中,λ为迭代周期,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
步骤S302:控制器110根据位姿偏差调整机械臂120位姿,以减小接触力。Step S302: The
具体实现中,根据位姿偏差调整机械臂120位姿后,再次获取传感器150采集的连接头140与目标接口100之间的接触力,直至接触力小于偏差阈值。In a specific implementation, after adjusting the pose of the
需要说明的是,在控制器110根据接触力调整机械臂120位姿的过程中,为了提高连接头140与目标接口100对接的精度,控制器110可以是实时持续的获取连接头140与目标接口100之间的接触力。但是,这样会增加控制器110计算的数据量以及接线系统的能耗。为了降低接线系统的能耗,提高接线效率,控制器110可以以一定的采样频率获取接触力,或者,通过设置位姿变化阈值,当机械臂120的位姿变化大于位姿变化阈值时,控制器110获取接触力。本申请对此不做具体限定。It should be noted that, in the process of the
步骤S108:如果接触力小于偏差阈值,控制器110控制机械臂120,使连接头140插入到目标接口100中。Step S108: If the contact force is less than the deviation threshold, the
具体实现中,如果接触力小于偏差阈值,则说明连接头140与目标接口100已经对准,控制器110可以控制机械臂120,使连接头140插入目标接口100中。In a specific implementation, if the contact force is less than the deviation threshold, it means that the
本申请实施例提供的接线方法,控制器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
本申请实施例还提供一种计算机存储介质,计算机存储介质中存储有计算机指令,当其在计算机上运行时,使得计算机执行上述各方面的方法。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)
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)
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)
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)
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 |
-
2021
- 2021-07-22 CN CN202110832521.3A patent/CN114441807B/en active Active
Patent Citations (6)
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 |