Robotic arm dragging teaching method, device, equipment, medium and product

By adopting a hybrid control mode in the robotic arm drag teaching, combining position, speed and torque control, the problems of end posture control difficulties and strange failures are solved, and the stability and flexibility of drag teaching are improved.

CN118789523BActive Publication Date: 2024-12-03SUZHOU ELITE ROBOTICS CO LTD +1
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
CN202411283203.6
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-09-13
Publication Date
2024-12-03
Estimated Expiration
2044-09-13

AI Technical Summary

Technical Problem

There are problems in the robotic arm drag teaching that cannot control the end posture or delays during dragging startup and strange failures, which affect the stability and flexibility of the dragging process.

Method used

Adopt mixed control modes of different joints, including position control mode, speed control mode and torque control mode. By obtaining motion parameters, state parameters and working configuration parameters, the control commands for each joint are determined to realize the drag of the preset end posture. Teach and avoid strange problems.

Benefits of technology

Without affecting drag flexibility and fast response, ensure that the end of the robot arm always maintains a preset posture, improve the stability of drag teaching, and avoid strange problems and time lags during the dragging process.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118789523B_ABST
    Figure CN118789523B_ABST
Patent Text Reader

Abstract

The embodiment of the present invention discloses a method, device, equipment, medium and product for dragging teaching of a robot arm, wherein the method includes: determining the control instructions of each joint according to the motion parameters, control mode and preset terminal posture constraint parameters, so as to realize dragging teaching that satisfies the preset terminal posture constraint parameters; wherein the control mode of each joint is a position, speed or torque control mode, the control mode of each joint is not completely the same, and at least one joint is a torque control mode. The technical solution of the embodiment of the present invention solves the problem in the prior art that the robot arm dragging teaching cannot control the terminal posture, or the time lag phenomenon of dragging start and the singular failure during the dragging process when the terminal posture can be controlled. Through a hybrid control method, the robot arm end can always maintain a preset posture while avoiding the singular problem of the dragging process without affecting the flexibility and rapid responsiveness of the dragging, thereby improving the stability of the dragging teaching.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The embodiments of the present invention relate to the field of robot arm control technology, and in particular to a robot arm dragging teaching method, device, equipment, medium and product. Background Art

[0002] At present, there are two main ways to implement the dragging teaching function of the robot arm. One is the zero-force dragging solution, in which all joint servos are in torque mode. The controller sends torque commands to compensate for the gravity torque, Coriolis and centripetal torque, and friction torque of the robot arm so that the robot arm is in a suspended state at any time. At this time, the robot arm can be pushed by external force, thereby realizing the dragging function. However, the zero-force dragging solution cannot constrain the posture of the end of the robot arm during the dragging process.

[0003] The other is a dragging solution based on a six-dimensional force / torque sensor or joint torque sensor or end external force estimation. In this solution, all joint servos are in position or speed control mode. The controller converts the end external force or joint external torque into joint acceleration through the method of admittance control, and finally outputs the joint position or joint speed through integration to achieve the dragging function. Although this solution can constrain the posture of the end of the robot arm during the dragging process, there will be obvious time lag problems at the beginning of the dragging start-up stage, and there will inevitably be singular problems in the process of constraining the Cartesian space posture of the end of the robot arm, that is, when encountering or approaching a singular point, the user cannot drag or the Cartesian space posture constraint fails. Summary of the invention

[0004] The embodiments of the present invention provide a method, device, equipment, medium and product for teaching dragging of a robotic arm. By adopting a hybrid control method with different control modes for different joints, the end of the robotic arm can always maintain a preset posture while avoiding singular problems in the dragging process without affecting the dragging flexibility and rapid responsiveness, thereby improving the stability of the dragging teaching.

[0005] In a first aspect, an embodiment of the present invention provides a robot arm dragging teaching method, the method comprising:

[0006] Obtaining motion parameters and state parameters of each joint of the target robotic arm and working configuration parameters of the target robotic arm;

[0007] Determine the control instructions of each joint in the corresponding control mode according to the motion parameters, state parameters, working configuration parameters, the control mode of each joint and the preset end posture constraint parameters of the target robot arm;

[0008] Control the corresponding joints according to the control instructions to achieve drag teaching that meets the preset end posture constraint parameters;

[0009] Among them, the control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of each joint is not completely the same, and the control mode of at least one joint is a torque control mode.

[0010] In a second aspect, an embodiment of the present invention provides a robot arm dragging teaching device, the device comprising:

[0011] A parameter acquisition module, used to acquire motion parameters and state parameters of each joint of the target robotic arm and working configuration parameters of the target robotic arm;

[0012] A control instruction determination module determines the control instruction of each joint under the corresponding control mode according to the motion parameters, state parameters, working configuration parameters, the control mode of each joint and the preset end posture constraint parameters of the target manipulator;

[0013] A control instruction output module is used to control the corresponding joint according to the control instruction to achieve drag teaching that meets the preset end posture constraint parameters;

[0014] Among them, the control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of each joint is not completely the same, and the control mode of at least one joint is a torque control mode.

[0015] In a third aspect, an embodiment of the present invention further provides a computer device, the computer device comprising:

[0016] one or more processors;

[0017] A memory for storing one or more programs;

[0018] When the one or more programs are executed by the one or more processors, the one or more processors implement the robot arm dragging teaching method provided by any embodiment of the present invention.

[0019] In a fourth aspect, an embodiment of the present invention further provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements a robot arm dragging teaching method as provided in any embodiment of the present invention.

[0020] In a fifth aspect, an embodiment of the present invention further provides a computer program product, including a computer program, which, when executed by a processor, implements the robot arm dragging teaching method provided in any embodiment of the present invention.

[0021] The embodiments of the above invention have the following advantages or beneficial effects:

[0022] In the embodiment of the present invention, the motion parameters, state parameters and working configuration parameters of each joint of the target manipulator are obtained; the control instructions of each joint under the corresponding control mode are determined according to the motion parameters, state parameters, working configuration parameters, the control mode of each joint and the preset terminal posture constraint parameters of the target manipulator; the corresponding joint is controlled according to the control instructions to realize the drag teaching that satisfies the preset terminal posture constraint parameters; wherein the control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of each joint is not completely the same, and the control mode of at least one joint is a torque control mode. The technical solution of the embodiment of the present invention solves the problem that the manipulator drag teaching in the prior art cannot control the terminal posture, or the time lag phenomenon of drag start and the singular failure during the drag process are generated when the terminal posture can be controlled. By adopting a hybrid control method of different control modes for different joints, the manipulator end can always maintain the preset posture while avoiding the singular problem of the drag process without affecting the flexibility and rapid responsiveness of the drag, thereby improving the stability of the drag teaching. BRIEF DESCRIPTION OF THE DRAWINGS

[0023] Figure 1 is a flow chart of a robot arm dragging teaching method provided by an embodiment of the present invention;

[0024] Figure 2 is a flow chart of a robot arm dragging teaching method provided by an embodiment of the present invention;

[0025] Figure 3 is a flow chart of a robot arm dragging teaching method provided by an embodiment of the present invention;

[0026] Figure 4 is a schematic diagram of a five-axis palletizing and handling robot arm provided in an embodiment of the present invention;

[0027] Figure 5 is a schematic diagram of a robot arm dragging teaching method provided by an embodiment of the present invention;

[0028] Figure 6 It is a structural schematic diagram of a mechanical arm dragging teaching device provided by an embodiment of the present invention;

[0029] Figure 7 It is a structural schematic diagram of a computer device provided by an embodiment of the present invention. DETAILED DESCRIPTION

[0030] The present invention will be further described in detail below in conjunction with the accompanying drawings and embodiments. It is to be understood that the specific embodiments described herein are only used to explain the present invention, rather than to limit the present invention. It should also be noted that, for ease of description, only parts related to the present invention, rather than all structures, are shown in the accompanying drawings.

[0031] Figure 1 The present invention provides a flowchart of a robot arm dragging teaching method, which can be applied to robot arm dragging teaching scenarios. The method can be performed by a robot arm dragging teaching device, which can be implemented by software and / or hardware and integrated into a computer device with application development functions.

[0032] like Figure 1 As shown, the robot arm dragging teaching method of this embodiment includes the following steps:

[0033] S110, obtaining motion parameters and state parameters of each joint of the target robotic arm and working configuration parameters of the target robotic arm.

[0034] The target robot arm may be a multi-axis robot arm, specifically a robot arm including more than one joint. The motion parameters may include the position, speed and acceleration of each joint movement. The motion parameters of each joint may be obtained through a preset sensor or encoder.

[0035] Working configuration parameters may include load parameters, installation method parameters, and tool parameters. Tool parameters may be tool TCP parameters, such as the position and posture (position and attitude) of the tool TCP coordinate system in the flange coordinate system. Load parameters may refer to the total mass and center of mass of the tool and other loads installed at the end of the robot arm. State parameters may be non-motion parameters generated during joint motion, such as joint temperature parameters.

[0036] S120, determining the control instructions of each joint under the corresponding control mode according to the motion parameters, state parameters, working configuration parameters, the control mode of each joint and the preset end posture constraint parameters of the target robot arm.

[0037] Among them, the control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of each joint is not completely the same, and the control mode of at least one joint is a torque control mode.

[0038] At present, when all joint servos are in torque mode, the posture of the end of the robot arm cannot be constrained during the dragging process. When the joint servos are in position control mode or speed control mode, the end external force or joint external torque is converted into joint acceleration through the admittance control method, and finally the joint position or joint speed is output. Although the posture of the end of the robot arm can be constrained during the dragging process, there will be obvious time lag problems at the beginning of the dragging start-up stage, and there will be singular problems during the dragging process. When encountering or approaching a singular point, the user cannot drag or the Cartesian space posture constraint fails.

[0039] To solve the above problems, this embodiment is based on a robot arm dragging teaching method with a mixed joint control mode, which performs mixed control through the position or speed control mode and the torque control mode of the joint servo, performs torque control on certain joints of the robot arm and sends torque control instructions, while performs position or speed control on the remaining joints and sends position or speed control instructions.

[0040] Specifically, for joints in different control modes, the control instructions of each joint in the corresponding control mode are determined according to the calculation method of the control instructions corresponding to the control mode. For joints in position or speed control mode, the control instructions may be position or speed control instructions. For joints in torque control mode, the control instructions may be torque control instructions. The position or speed control instructions of the joints in position or speed control mode can be calculated by inputting motion parameters, work configuration parameters and preset end posture constraint parameters into a preset robotic arm end posture constraint calculation model based on a preset geometric constraint algorithm, so that the joints in position or speed control mode can realize drag teaching under the corresponding control instructions, and compensate in real time for the error between the robotic arm end posture and the target posture corresponding to the preset end posture constraint parameters set by the user, so that the end of the target robotic arm maintains the posture corresponding to the preset end posture constraint parameters.

[0041] For joints in torque control mode, motion parameters, state parameters and working configuration parameters can be input into the preset robotic arm dynamics model calculation module to calculate the corresponding torque control instructions to compensate for the gravity torque, Coriolis and centripetal torque and friction torque of the target robotic arm, so that the target robotic arm is in a suspended state at any time, thereby realizing the function that these joints can be dragged when the robotic arm is subjected to external dragging force.

[0042] This embodiment uses hybrid control to avoid the current control of all joint positions or speeds, which may lead to dragging lag problems and singularity problems, and also avoids the problem of the end posture being unable to be maintained due to the control of all joint torques. While ensuring the stability and smoothness of the dragging teaching, it can avoid the end of the robot arm from flipping over, resulting in an unsmooth dragging process, or flipping over in specific scenarios such as palletizing and handling, causing unsafe problems.

[0043] S130, controlling corresponding joints according to the control instructions to achieve drag teaching that satisfies preset terminal posture constraint parameters.

[0044] During the control process of the target robot arm dragging teaching, in each preset control cycle, the torque control instructions of all joints in the torque control mode calculated and output by the preset robot arm dynamics model of the target robot arm are integrated with the position or speed control instructions of the joints in the position control mode or speed control mode calculated and output by the preset end posture constraint model based on the geometric constraint algorithm, and sent to the servo motor drive module of each joint, so that the servo motor drive module of the joint controls the corresponding joint according to the control instruction, performs target position or speed tracking or target torque tracking, and completes the dragging teaching.

[0045] The technical solution of this embodiment is to obtain the motion parameters, state parameters and working configuration parameters of each joint of the target manipulator; determine the control instructions of each joint under the corresponding control mode according to the motion parameters, state parameters, working configuration parameters, the control mode of each joint and the preset terminal posture constraint parameters of the target manipulator; control the corresponding joint according to the control instructions to achieve drag teaching that meets the preset terminal posture constraint parameters; wherein the control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of each joint is not completely the same, and the control mode of at least one joint is a torque control mode. The technical solution of the embodiment of the present invention solves the problem that the manipulator drag teaching in the prior art cannot control the terminal posture, or the time lag phenomenon of drag start and the singular failure during the drag process are generated when the terminal posture can be controlled. By adopting a hybrid control method of different control modes for different joints, the manipulator end can always maintain the preset posture while avoiding the singular problem of the drag process without affecting the drag compliance and rapid responsiveness, thereby improving the stability of the drag teaching.

[0046] Figure 2 This is a flowchart of a robot arm dragging teaching method provided by an embodiment of the present invention. This embodiment and the robot arm dragging teaching method in the above embodiment belong to the same inventive concept, and further describes the calculation process of the joint control command. The method can be executed by a robot arm dragging teaching device, which can be implemented by software and / or hardware and integrated into a computer device with application development function.

[0047] like Figure 2 As shown, the robot arm dragging teaching method of this embodiment includes the following steps:

[0048] S210: Before the drag teaching starts, obtain preset end posture constraint parameters of the target robot arm.

[0049] Before the drag teaching starts, obtaining preset end posture constraint parameters of the target robot arm;

[0050] The preset end posture constraint parameter is the angle value between the vertical axis of the end of the target robot arm in the tool coordinate system and the vertical axis in the preset Cartesian space coordinate system.

[0051] At present, during the dragging teaching process of a robotic arm, such as the dragging teaching process of a five-axis palletizing and handling robotic arm, the end of the robotic arm flips up and down during the dragging process and cannot maintain a vertical downward posture, that is, the angle between the vertical axis of the tool coordinate system of the end of the robotic arm and the vertical axis in the preset Cartesian space coordinate system is not 0, which affects the effect of the user dragging the robotic arm and may cause safety issues.

[0052] To solve the above problem, in this embodiment, before the drag teaching begins, the preset end posture constraint parameters of the target robotic arm input by the user are obtained, so that the target robotic arm can be controlled by the preset end posture constraint parameters to always maintain the posture represented by the preset end posture constraint parameters during the movement, that is, always maintain a fixed angle value with the vertical axis Z axis in the preset Cartesian space coordinate system in the vertical downward direction.

[0053] It is understandable that for different multi-axis robotic arms and robotic arms in different application scenarios, the end fixed postures required by users may be different. Therefore, in this embodiment, the preset end posture constraint parameters can be any angle value.

[0054] S220: Obtain motion parameters and state parameters of each joint of the target robotic arm and working configuration parameters of the target robotic arm.

[0055] S230, inputting preset end posture constraint parameters, motion parameters and working configuration parameters into a preset robot arm end posture constraint calculation model, and calculating to obtain a position control instruction or a speed control instruction of a joint in a position control mode or a speed control mode.

[0056] Based on the current position, speed, and acceleration information of each joint of the target robotic arm obtained in real time, and the preset end posture constraint parameters set by the user, that is, the angle parameters between the Z-axis of the tool coordinate system of the target robotic arm and the vertical downward direction of the Z-axis of the preset Cartesian coordinate system, and the working configuration parameters, the control instructions of all joints performing position or speed control, that is, the position or speed control instructions, are calculated through the preset robotic arm end posture constraint calculation model.

[0057] This position or speed control instruction can compensate in real time for the error between the end posture of the robot arm and the target angle of the preset end posture constraint parameter set by the user, and realize the linkage between the position or speed control joint and the torque control joint, thereby ensuring that the trajectory obtained during the drag teaching process and the drag teaching process are all in compliance with the target angle constraint of the preset end posture constraint parameter set by the user.

[0058] Specifically, the target robot arm controls all joints that perform position or speed control during the dragging process, i.e., joint positions Or speed control command , can be calculated according to the following preset robot end posture constraint calculation model:

[0059] ;

[0060] ;

[0061] in, are the position, velocity and acceleration of each joint of the target robotic arm respectively. The preset end posture constraint parameter set by the user is the angle between the Z axis of the target robot arm tool coordinate system and the vertical downward direction of the Z axis of the preset Cartesian coordinate system. The preset robot arm end posture constraint calculation model is a mathematical model based on a geometric space constraint algorithm.

[0062] For a five-axis robotic arm used in palletizing and handling scenarios, if the angle between the Z-axis of the target robotic arm's tool coordinate system and the vertical downward direction of the Z-axis of the user-defined preset Cartesian coordinate system is 0 degrees, then the joint position or speed control instructions calculated and output by the preset robotic arm end posture constraint calculation model can ensure that the end of the target robotic arm is always vertically downward and does not flip during the dragging process.

[0063] S240, input the motion parameters, state parameters and working configuration parameters into the preset robot arm dynamics model calculation module, calculate the torque value of each preset torque item, and determine the torque control instruction of the joint in the torque control mode according to each torque value.

[0064] The robot arm dynamics model calculation module can calculate the control instructions of all joints in the torque control mode, namely the joint torque instructions, based on the current position, speed and acceleration of the robot arm, as well as working configuration parameters such as load parameters (including the mass center of mass of the tool), installation method parameters, tool parameters, and state parameters such as joint temperature parameters.

[0065] The preset torque items may include inertia torque, gravity torque, Coriolis and centripetal torque, and friction torque. Therefore, during the drag teaching process, the joint torque command can compensate for the inertia torque, gravity torque, Coriolis and centripetal torque, and friction torque of the target robot arm, so that the joint of the target robot arm in the torque control mode is in a suspended state, thereby realizing the function that the joint in the torque control mode can be dragged when the target robot arm is subjected to an external drag force.

[0066] In an optional embodiment, the torque control instruction of the joint in the torque control mode is determined according to each torque value, and each torque value can be added to obtain the torque control instruction of the joint in the torque control mode; wherein the torque value includes inertia torque value, Coriolis and centripetal torque value, gravity torque value and friction torque value.

[0067] Specifically, the joint torque command of the robot arm during the dragging process , can be calculated according to the following preset robot arm dynamics model:

[0068] .

[0069] in, are the position, velocity and acceleration of each joint of the robotic arm respectively. is the inertia moment of the preset robot arm dynamics model. Coriolis and centripetal moments of the preset robot arm dynamics model. is the gravity moment of the preset robot arm dynamics model, is the environmental acceleration considering the inertial force. is the friction torque of the preset robot arm dynamics model, is the joint temperature, is the joint load moment.

[0070] S250, controlling the corresponding joints according to the control instructions to achieve drag teaching that satisfies preset terminal posture constraint parameters.

[0071] The technical solution of this embodiment is as follows: before the start of drag teaching, the preset end posture constraint parameters of the target robotic arm are obtained; the motion parameters, state parameters of each joint of the target robotic arm and the working configuration parameters of the target robotic arm are obtained; the preset end posture constraint parameters, motion parameters and working configuration parameters are input into a preset robotic arm end posture constraint calculation model, and the position control instructions or speed control instructions of the joints in the position control mode or speed control mode are calculated; the motion parameters, state parameters and working configuration parameters are input into a preset robotic arm dynamics model calculation module, and the torque value of each preset torque item is calculated, and the torque control instructions of the joints in the torque control mode are determined according to each torque value; and the corresponding joints are controlled according to the control instructions to achieve drag teaching that meets the preset end posture constraint parameters. The technical solution of the embodiment of the present invention solves the problem in the prior art that the dragging teaching of the robot arm cannot control the end posture, or when the end posture can be controlled, a time lag phenomenon occurs in the dragging start and a singular failure occurs during the dragging process. The end of the robot arm can be kept in a fixed posture by putting some joints in a position control mode or a speed control mode, and the time lag problem and the singularity problem can be avoided by putting some joints in a torque control mode. Without affecting the flexibility and rapid responsiveness of the dragging, the end of the robot arm can be kept in a preset posture at all times, while avoiding the singularity problem during the dragging process, thereby improving the stability of the dragging teaching.

[0072] Figure 3 This is a flowchart of a robot arm dragging teaching method provided by an embodiment of the present invention. This embodiment and the robot arm dragging teaching method in the above embodiment belong to the same inventive concept, and further describes the process of controlling the corresponding joint according to the control instruction. The method can be executed by a robot arm dragging teaching device, which can be implemented by software and / or hardware and integrated into a computer device with application development function.

[0073] like Figure 3 As shown, the robot arm dragging teaching method of this embodiment includes the following steps:

[0074] S310: Obtain motion parameters and state parameters of each joint of the target robotic arm and working configuration parameters of the target robotic arm.

[0075] S320, determining the control instructions of each joint under the corresponding control mode according to the motion parameters, state parameters, working configuration parameters, the control mode of each joint and the preset end posture constraint parameters of the target robot arm.

[0076] The control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of at least one joint is different from that of other joints.

[0077] S330. Send the control instruction to the servo motor drive module of the joint corresponding to the control instruction in accordance with the preset communication protocol format, so that the servo motor drive module of the joint executes the received position control instruction, speed control instruction or torque control instruction to achieve drag teaching that meets the preset end posture constraint parameters.

[0078] The control instructions include joint position or speed control instructions corresponding to the joints in the position or speed control mode, and joint torque control instructions corresponding to the joints in the torque control mode.

[0079] In each control cycle of the control process of dragging and teaching the robot arm, the torque control instructions of the torque control joints are integrated with the position or speed control instructions of all position or speed control joints, and sent to the servo motor drive modules of each joint in a preset communication protocol format to control the joints.

[0080] The servo motor drive module of each joint will receive the joint torque command and the joint position or speed command in each control cycle. The servo motor drive module of each joint will perform torque tracking and position or speed tracking according to the received joint torque command and joint position or speed command and the target torque and target position or speed corresponding to the command, so as to realize the drag teaching function that meets the preset end posture constraint parameters.

[0081] In an optional embodiment, the target robotic arm is a five-axis robotic arm, and the five-axis robotic arm includes five joints.

[0082] like Figure 4 As shown, Figure 4 This is a schematic diagram of a five-axis palletizing and handling robot. Figure 4 From top to bottom in the figure, they are joint 1, joint 2, joint 3, joint 4 and joint 5. The joints 1, 2, 3 and 5 of the target manipulator can be subjected to torque control, and joint 4 can be subjected to position control. Alternatively, the joints 1, 2, 4 and 5 can be subjected to torque control, and joint 3 can be subjected to position control. Of course, the joints 1, 3, 4 and 5 can be subjected to torque control, and joint 2 can be subjected to position control. Preferably, the control mode of the joints that are relatively closer to the end can be determined as the position control mode or the speed control mode to enhance the effect of the end posture constraint.

[0083] The technical solution of this embodiment is to obtain the motion parameters, state parameters and working configuration parameters of each joint of the target manipulator; determine the control instructions of each joint under the corresponding control mode according to the motion parameters, state parameters, working configuration parameters, the control mode of each joint and the preset terminal posture constraint parameters of the target manipulator; send the control instructions to the servo motor drive module of the joint corresponding to the control instructions according to the preset communication protocol format, so that the servo motor drive module of the joint executes the received position control instructions, speed control instructions or torque control instructions to achieve drag teaching that meets the preset terminal posture constraint parameters; wherein the control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of each joint is not completely the same, and the control mode of at least one joint is a torque control mode. The technical solution of the embodiment of the present invention solves the problem that the manipulator drag teaching in the prior art cannot control the terminal posture, or the time lag phenomenon of drag start and the singular failure during the drag process are generated when the terminal posture can be controlled. The hybrid control and unified control instructions can be issued, so that the end of the manipulator always maintains the preset posture while avoiding the singular problem of the drag process without affecting the flexibility and rapid responsiveness of the drag, thereby improving the stability of the drag teaching.

[0084] like Figure 5 As shown, Figure 5 As a preferred embodiment of the present invention, Figure 5 In the robot arm dragging teaching method shown, the user parameter setting module obtains the preset end posture constraint parameters input by the user, and the robot arm state information acquisition module obtains the current position, speed, acceleration, load parameters (including the mass center of mass of the tool), installation method parameters and tool parameters, joint temperature and other information of each joint of the robot arm. The robot arm dynamics model calculation module calculates the joint torque command of the torque-controlled joint according to the current position, speed, acceleration, load parameters, installation method parameters and tool parameters, joint temperature and other data of each joint. The robot arm end posture angle constraint model calculation module calculates the joint position or speed control command of the position or speed controlled joint according to the preset end posture constraint parameters, the current position, speed and acceleration of each joint, installation method parameters, tool parameters and other data. The joint torque and position or speed command integration and issuance module integrates the control commands of the joints of different control methods and sends them to the joint servo execution module. The joint servo execution module controls the driving joint according to the control command of the joint, that is, the joint torque command or the joint position or speed command.

[0085] Figure 6The present invention provides a schematic diagram of a mechanical arm dragging teaching device according to an embodiment of the present invention. This embodiment is applicable to the mechanical arm dragging teaching scenario. The mechanical arm dragging teaching device can be implemented by software and / or hardware and integrated into a computer terminal device with application development function.

[0086] like Figure 6 As shown, the robot arm dragging teaching device includes: a parameter acquisition module 410, a control instruction determination module 420 and a control instruction output module 430.

[0087] Among them, the parameter acquisition module 410 is used to obtain the motion parameters, state parameters of each joint of the target robotic arm and the working configuration parameters of the target robotic arm; the control instruction determination module 420 determines the control instructions of each joint under the corresponding control mode according to the motion parameters, state parameters, working configuration parameters, the control mode of each joint and the preset end posture constraint parameters of the target robotic arm; the control instruction output module 430 is used to control the corresponding joint according to the control instruction to achieve drag teaching that meets the preset end posture constraint parameters; wherein the control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of each joint is not exactly the same, and the control mode of at least one joint is a torque control mode.

[0088] The technical solution of this embodiment is to obtain the motion parameters, state parameters and working configuration parameters of each joint of the target manipulator; determine the control instructions of each joint under the corresponding control mode according to the motion parameters, state parameters, working configuration parameters, the control mode of each joint and the preset terminal posture constraint parameters of the target manipulator; control the corresponding joint according to the control instructions to achieve drag teaching that meets the preset terminal posture constraint parameters; wherein the control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of each joint is not completely the same, and the control mode of at least one joint is a torque control mode. The technical solution of the embodiment of the present invention solves the problem that the manipulator drag teaching in the prior art cannot control the terminal posture, or the time lag phenomenon of drag start and the singular failure during the drag process are generated when the terminal posture can be controlled. By adopting a hybrid control method of different control modes for different joints, the manipulator end can always maintain the preset posture while avoiding the singular problem of the drag process without affecting the drag compliance and rapid responsiveness, thereby improving the stability of the drag teaching.

[0089] In an optional embodiment, the above device further includes:

[0090] The preset end posture constraint parameter acquisition module is used to obtain the preset end posture constraint parameters of the target robot arm before the drag teaching starts; wherein the preset end posture constraint parameters are the angle value between the vertical axis of the end of the target robot arm in the tool coordinate system and the vertical axis in the preset Cartesian space coordinate system.

[0091] In an optional implementation, the control instruction determination module 420 is specifically used to:

[0092] The preset end posture constraint parameters, motion parameters and working configuration parameters are input into the preset robot arm end posture constraint calculation model to calculate the position control instructions or speed control instructions of the joints in the position control mode or speed control mode; the motion parameters, state parameters and working configuration parameters are input into the preset robot arm dynamics model calculation module to calculate the torque value of each preset torque item, and the torque control instructions of the joints in the torque control mode are determined according to each torque value.

[0093] In an optional implementation, the control instruction determination module 420 is further configured to:

[0094] Each torque value is added together to obtain the torque control instruction of the joint in the torque control mode; wherein the torque value includes the inertia torque value, the Coriolis and centripetal torque value, the gravity torque value and the friction torque value.

[0095] In an optional implementation, the control instruction output module 430 is specifically used for:

[0096] The control instruction is sent to the servo motor drive module of the joint corresponding to the control instruction in accordance with a preset communication protocol format, so that the servo motor drive module of the joint executes the received position control instruction, speed control instruction or torque control instruction.

[0097] In an optional embodiment, the target robotic arm is a five-axis robotic arm, and the five-axis robotic arm includes five joints.

[0098] The robot arm dragging teaching device provided in the embodiment of the present invention can execute the robot arm dragging teaching method provided in any embodiment of the present invention, and has the corresponding functional modules and beneficial effects of the execution method.

[0099] Figure 7 A schematic diagram of the structure of a computer device provided in an embodiment of the present invention. Figure 7 A block diagram of an exemplary computer device 12 suitable for use in implementing embodiments of the present invention is shown. Figure 7The computer device 12 shown is only an example and should not bring any limitation to the functions and scope of use of the embodiments of the present invention. The computer device 12 can be any terminal device with computing capabilities, such as an intelligent controller and server, a mobile phone and other terminal devices.

[0100] like Figure 7 As shown, the computer device 12 is in the form of a general-purpose computing device. The components of the computer device 12 may include, but are not limited to: one or more processors or processing units 16, a system memory 28, and a bus 18 that connects various system components (including the system memory 28 and the processing unit 16).

[0101] Bus 18 represents one or more of several types of bus structures, including a memory bus or memory controller, a peripheral bus, an accelerated graphics port, a processor or a local bus using any of a variety of bus architectures. By way of example, these architectures include, but are not limited to, an Industry Standard Architecture (ISA) bus, a Micro Channel Architecture (MAC) bus, an Enhanced ISA bus, a Video Electronics Standards Association (VESA) local bus, and a Peripheral Component Interconnect (PCI) bus.

[0102] The computer device 12 typically includes a variety of computer system readable media. These media can be any available media that can be accessed by the computer device 12, including volatile and non-volatile media, removable and non-removable media.

[0103] The system memory 28 may include computer system readable media in the form of volatile memory, such as random access memory (RAM) 30 and / or cache memory 32. The computer device 12 may further include other removable / non-removable, volatile / non-volatile computer system storage media. By way of example only, the storage system 34 may be used to read and write non-removable, non-volatile magnetic media ( Figure 7 not shown, usually called a "hard drive"). Although Figure 7 Not shown in the figure, a disk drive for reading and writing to a removable non-volatile disk (e.g., a "floppy disk"), and an optical disk drive for reading and writing to a removable non-volatile optical disk (e.g., a CD-ROM, a DVD-ROM, or other optical media) may be provided. In these cases, each drive may be connected to the bus 18 via one or more data medium interfaces. The system memory 28 may include at least one program product having a set (e.g., at least one) of program modules that are configured to perform the functions of the various embodiments of the present invention.

[0104] A program / utility 40 having a set (at least one) of program modules 42 may be stored, for example, in system memory 28, such program modules 42 including, but not limited to, an operating system, one or more application programs, other program modules, and program data, each of which or some combination may include an implementation of a network environment. Program modules 42 generally perform the functions and / or methods of the embodiments described herein.

[0105] The computer device 12 may also communicate with one or more external devices 14 (e.g., keyboards, pointing devices, displays 24, etc.), one or more devices that enable a user to interact with the computer device 12, and / or any device that enables the computer device 12 to communicate with one or more other computing devices (e.g., a network card, a modem, etc.). Such communication may be performed via an input / output (I / O) interface 22. In addition, the computer device 12 may also communicate with one or more networks (e.g., a local area network (LAN), a wide area network (WAN), and / or a public network, such as the Internet) via a network adapter 20. As shown, the network adapter 20 communicates with the other modules of the computer device 12 via a bus 18. It should be understood that although Figure 7 Not shown, other hardware and / or software modules may be used in conjunction with computer device 12, including but not limited to: microcode, device drivers, redundant processing units, external disk drive arrays, RFID systems, tape drives, and data backup storage systems.

[0106] The processing unit 16 executes various functional applications and data processing by running the program stored in the system memory 28, for example, implementing the robot arm dragging teaching method provided in the embodiment of the present invention, the method comprising:

[0107] Obtaining motion parameters and state parameters of each joint of the target robotic arm and working configuration parameters of the target robotic arm;

[0108] Determine the control instructions of each joint in the corresponding control mode according to the motion parameters, state parameters, working configuration parameters, the control mode of each joint and the preset end posture constraint parameters of the target robot arm;

[0109] Control the corresponding joints according to the control instructions to achieve drag teaching that meets the preset end posture constraint parameters;

[0110] Among them, the control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of each joint is not completely the same, and the control mode of at least one joint is a torque control mode.

[0111] An embodiment of the present invention further provides a computer-readable storage medium having a computer program stored thereon. When the program is executed by a processor, the robot arm dragging teaching method provided by any embodiment of the present invention is implemented. The method includes:

[0112] Obtaining motion parameters and state parameters of each joint of the target robotic arm and working configuration parameters of the target robotic arm;

[0113] Determine the control instructions of each joint in the corresponding control mode according to the motion parameters, state parameters, working configuration parameters, the control mode of each joint and the preset end posture constraint parameters of the target robot arm;

[0114] Control the corresponding joints according to the control instructions to achieve drag teaching that meets the preset end posture constraint parameters;

[0115] Among them, the control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of each joint is not completely the same, and the control mode of at least one joint is a torque control mode.

[0116] The computer storage medium of the embodiment of the present invention can adopt any combination of one or more computer-readable media. The computer-readable medium can be a computer-readable signal medium or a computer-readable storage medium. The computer-readable storage medium can be, for example, but not limited to: an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device or device, or any combination of the above. More specific examples (non-exhaustive list) of computer-readable storage media include: an electrical connection with one or more wires, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above. In this document, a computer-readable storage medium can be any tangible medium containing or storing a program, which can be used by an instruction execution system, device or device or used in combination with it.

[0117] Computer-readable signal media may include data signals propagated in baseband or as part of a carrier wave, which carry computer-readable program code. Such propagated data signals may take a variety of forms, including but not limited to electromagnetic signals, optical signals, or any suitable combination of the above. Computer-readable signal media may also be any computer-readable medium other than a computer-readable storage medium, which may send, propagate, or transmit a program for use by or in conjunction with an instruction execution system, apparatus, or device.

[0118] The program code embodied on the computer readable medium may be transmitted using any appropriate medium, including but not limited to wireless, wireline, optical fiber cable, RF, etc., or any suitable combination of the foregoing.

[0119] Computer program code for performing the operation of the present invention may be written in one or more programming languages ​​or a combination thereof, including object-oriented programming languages ​​such as Java, Smalltalk, Python, C++, and conventional procedural programming languages ​​such as "C" or similar programming languages. The program code may be executed entirely on the user's computer, partially on the user's computer, as an independent software package, partially on the user's computer and partially on a remote computer, or entirely on a remote computer or server. In the case of a remote computer, the remote computer may be connected to the user's computer through any type of network, including a local area network (LAN) or a wide area network (WAN), or may be connected to an external computer (e.g., using an Internet service provider to connect through the Internet).

[0120] An embodiment of the present invention further provides a computer program product, including a computer program, which, when executed by a processor, implements the robot arm dragging teaching method provided in any embodiment of the present application.

[0121] In the process of implementation, the computer program product can be written in one or more programming languages ​​or a combination thereof to perform the computer program code of the present invention, including object-oriented programming languages, such as Java, Smalltalk, Python, C++, and also conventional procedural programming languages, such as "C" language or similar programming languages. The program code can be executed entirely on the user's computer, partially on the user's computer, as an independent software package, partially on the user's computer and partially on a remote computer, or completely on a remote computer or server. In the case of a remote computer, the remote computer can be connected to the user's computer through any type of network, including a local area network (LAN) or a wide area network (WAN), or can be connected to an external computer (for example, using an Internet service provider to connect through the Internet).

[0122] It should be understood by those skilled in the art that the modules or steps of the present invention described above can be implemented by a general-purpose computing device, they can be concentrated on a single computing device, or distributed on a network composed of multiple computing devices, optionally, they can be implemented by a program code executable by a computer device, so that they can be stored in a storage device and executed by the computing device, or they can be made into individual integrated circuit modules, or multiple modules or steps therein can be made into a single integrated circuit module for implementation. Thus, the present invention is not limited to any specific combination of hardware and software.

[0123] Note that the above are only preferred embodiments of the present invention and the technical principles used. Those skilled in the art will understand that the present invention is not limited to the specific embodiments described herein, and that various obvious changes, readjustments and substitutions can be made by those skilled in the art without departing from the scope of protection of the present invention. Therefore, although the present invention has been described in more detail through the above embodiments, the present invention is not limited to the above embodiments, and may include more other equivalent embodiments without departing from the concept of the present invention, and the scope of the present invention is determined by the scope of the appended claims.

Claims

1. A robot arm dragging teaching method, characterized in that: include: Acquire motion parameters and state parameters of each joint of the target robotic arm and working configuration parameters of the target robotic arm; Determine the control instructions of each joint under the corresponding control mode according to the motion parameters, the state parameters, the working configuration parameters, the control mode of each joint and the preset end posture constraint parameters of the target robot arm; Controlling the corresponding joint according to the control instruction to achieve drag teaching that satisfies preset end posture constraint parameters; Among them, the control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of each joint is not completely the same, and the control mode of at least one joint is a torque control mode.

2. The method according to claim 1, characterized in that The method further comprises: Before the drag teaching starts, obtaining preset end posture constraint parameters of the target robot arm; The preset end posture constraint parameter is an angle value between a vertical axis of the end of the target robot arm in a tool coordinate system and a vertical axis in a preset Cartesian space coordinate system.

3. The method according to claim 1, characterized in that The step of determining the control instructions of each joint in the corresponding control mode according to the motion parameters, the state parameters, the working configuration parameters, the control mode of each joint and the preset end posture constraint parameters of the target robot arm comprises: Inputting the preset end posture constraint parameters, the motion parameters and the working configuration parameters into a preset robot arm end posture constraint calculation model, and calculating the position control instruction or speed control instruction of the joint in the position control mode or the speed control mode; The motion parameters, the state parameters and the working configuration parameters are input into a preset robot arm dynamics model calculation module to calculate the torque value of each preset torque item, and the torque control instruction of the joint in the torque control mode is determined according to each torque value.

4. The method according to claim 3, characterized in that The step of determining the torque control instruction of the joint in the torque control mode according to each of the torque values ​​comprises: Adding each of the torque values ​​to obtain a torque control instruction for the joint in the torque control mode; The torque values ​​include inertia torque values, Coriolis and centripetal torque values, gravity torque values ​​and friction torque values.

5. The method according to claim 1, characterized in that The controlling the corresponding joint according to the control instruction comprises: The control instruction is sent to the servo motor drive module of the joint corresponding to the control instruction in accordance with a preset communication protocol format, so that the servo motor drive module of the joint executes the received position control instruction, speed control instruction or torque control instruction.

6. The method according to any one of claims 1 to 5, characterized in that: The target robotic arm is a five-axis robotic arm, and the five-axis robotic arm includes five joints.

7. A robot arm dragging teaching device, characterized in that: include: A parameter acquisition module, used to acquire motion parameters and state parameters of each joint of a target robotic arm and working configuration parameters of the target robotic arm; A control instruction determination module, used to determine the control instruction of each joint under the corresponding control mode according to the motion parameter, the state parameter, the working configuration parameter, the control mode of each joint and the preset end posture constraint parameter of the target manipulator; A control instruction output module, used to control the corresponding joint according to the control instruction to achieve drag teaching that meets preset end posture constraint parameters; Among them, the control mode of each joint is a position control mode, a speed control mode or a torque control mode, and the control mode of each joint is not completely the same, and the control mode of at least one joint is a torque control mode.

8. A computer device, characterized in that: The computer device comprises: one or more processors; A memory for storing one or more programs; When the one or more programs are executed by the one or more processors, the one or more processors implement the robot arm dragging teaching method as described in any one of claims 1-6.

9. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the program is executed by a processor, the robot arm dragging teaching method as described in any one of claims 1-6 is implemented.

10. A computer program product, comprising a computer program, characterized in that When the computer program is executed by a processor, the computer program implements the robot arm dragging teaching method as described in any one of claims 1 to 6.

Citation Information

Patent Citations

  • Force-position mixed teaching robot system and teaching method

    CN112847366A