Arm and claw cooperative control method, device and equipment of humanoid robot and medium

By calculating and synchronizing the movement trajectory and joint angle of the robotic arm and agile hand claw, the coordinated control of the arm and claws of humanoid robots is achieved, solving the problems of complex and inconsistent joint control of arm and claws in the existing technology, and improving work efficiency and flexibility sex.

CN118977235APending Publication Date: 2024-11-19THE 21TH RES INST OF CHINA ELECTRONIC TECH GRP CORP

Patent Information

Application Number
CN202411033676.0
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-30
Publication Date
2024-11-19

AI Technical Summary

Technical Problem

In the prior art, the coordinated control of the arm and claws of humanoid robots is complex and inconsistent, and it is necessary to manually split the movements of the robotic arm and the clever hand claws for programming, resulting in a complex programming process and discontinuous movements, which affects the working efficiency of the robotic arm.

Method used

By obtaining the movement type, position, speed and other parameters of the robotic arm and clever hand claw, calculating its motion trajectory and joint angle, synchronous control of the robotic arm and clever hand claw, integrating its motion control, and using a common time axis to control the two movement of the person.

Benefits of technology

It reduces the programming complexity of arm-claw coordination scenarios, improves the flexibility and work efficiency of arm-claw coordination control, and ensures the coordinated movement of the robotic arm and agile hand-claw.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118977235A_ABST
    Figure CN118977235A_ABST
Patent Text Reader

Abstract

The invention provides an arm and claw cooperative control method for a humanoid robot. The arm and claw cooperative control method comprises the steps that the motion type of a mechanical arm and the initial pose and the target pose of the tail end of the mechanical arm are obtained; according to the motion type of the mechanical arm and the initial pose, the target pose, the initial speed and the target speed of the tail end of the mechanical arm, the angle of each joint of the mechanical arm in the motion process is calculated; according to the triggering condition, the initial position, the target position, the initial speed and the target speed of the dexterous gripper, the motion trail of the dexterous gripper is calculated; according to the invention, a motion control instruction of an arm and claw system is designed, the motion of the mechanical arm and the motion of the dexterous claw do not need to be separated for respective control in a scene requiring cooperative control of the arm and the claw, and the control method is simple and convenient to operate and high in control efficiency, and can be widely applied to the field of cooperative control of the mechanical arm and the dexterous claw. Movement of the mechanical arm and movement of the dexterous gripper can be associated and controlled through a common time axis.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the field of robot control, and in particular to a method, device, equipment and medium for coordinated control of an arm and claw of a humanoid robot. Background Art

[0002] The upper limbs of humanoid robots are divided into mechanical arms and dexterous grippers. The motion control method of mechanical arms is relatively mature, and the mechanical arms can be directly controlled to perform various complex movements through instructions. The control process of dexterous grippers is relatively simple, mainly controlling each finger to move at a specified speed. The control of the arm and gripper is basically controlled separately in the humanoid robot arm, and it is difficult to achieve coordinated control of the arm and gripper. Partial coordination can only be achieved through trajectory splitting and artificial combination. Figure 1 As shown in the figure, the robot arm is controlled from point A to point D. There is a point B in the middle that requires the dexterous gripper to perform certain actions, and the execution ends at point C. To realize this scenario, the path needs to be divided into three sections and programmed separately, which requires four instructions to complete. First, the robot arm moves to point B, then triggers the dexterous gripper to perform actions, and at the same time, the robot arm executes the movement from point B to point C, waits for synchronization with the dexterous gripper at point C, and finally the robot arm executes the movement from C to D to realize the coordinated work of the arm and gripper.

[0003] The existing technology is to achieve coordinated movement by using the commands of the robot arm and the dexterous gripper to control their respective movements respectively, and then artificially combine them. However, for complex coordinated movements of the arm and the gripper, it is necessary to artificially split them into the movements of the robot arm and the dexterous gripper, and then program and control them separately. The programming process of this method is relatively complicated, which increases the programming workload. After the split, the movement becomes discontinuous. There will be a certain time interval after each movement is completed, resulting in uncoordinated control of the robot arm and the dexterous gripper, affecting the work of the robot arm. Summary of the invention

[0004] The purpose of the present invention is to provide a method, device, equipment and medium for coordinated control of the arm and claw of a humanoid robot, thereby realizing synchronous control of the arm and claw system.

[0005] In order to achieve the above-mentioned objectives, the present invention provides the following technical solutions: a method for coordinated control of an arm and a claw of a humanoid robot, comprising: obtaining the motion type of the robotic arm, the initial position and the target position of the end of the robotic arm; calculating the angles of each joint of the robotic arm during the motion according to the motion type of the robotic arm, the initial position, the target position, the initial speed and the target speed of the end of the robotic arm; obtaining the triggering conditions, initial position, target position, initial speed and target speed of the dexterous claw; calculating the motion trajectory of the dexterous claw according to the triggering conditions, initial position, target position, initial speed and target speed of the dexterous claw; synchronously controlling the motion of the robotic arm and the dexterous claw of the robot according to the angles of each joint of the robotic arm and the motion trajectory of the dexterous claw during the motion.

[0006] Furthermore, the motion types of the robotic arm include linear motion, circular motion and mixed motion; the linear motion is that the end of the robotic arm moves along a linear path; the circular motion is that the end of the robotic arm moves along a circular path; the mixed motion is that the end of the robotic arm moves in the order of linear path, circular path, and linear path, and during the circular motion, the trajectory of the linear path is tangent to the trajectory of the circular path.

[0007] Furthermore, the method of calculating the angles of each joint of the robotic arm during the movement according to the movement type of the robotic arm, the initial position and target position of the end of the robotic arm includes: calculating the movement trajectory of the end of the robotic arm according to the movement type of the robotic arm, the initial position and target position of the end of the robotic arm; and converting the movement trajectory of the end of the robotic arm into the angles of each joint of the robotic arm during the movement.

[0008] Furthermore, the triggering conditions of the dexterous gripper include trigger type, trigger time, end time, trigger distance and end distance, and the trigger type includes time trigger and distance trigger; the time trigger is when the robot arm triggers the movement of the dexterous gripper after a set time has passed since the start of operation; the distance trigger is when the robot arm triggers the movement of the dexterous gripper after a set distance has passed since the start of operation.

[0009] Furthermore, the end time of the dexterous gripper is the time after a preset running time has passed since the triggering time of the dexterous gripper.

[0010] Further, when the motion type of the robotic arm is a mixed motion, calculating the motion trajectory of the robotic arm end according to the motion type, initial posture and motion target of the robotic arm includes: obtaining the midpoint posture between the initial posture and target posture of the robotic arm end; obtaining the radius of the circular arc path; calculating the center coordinates, starting point coordinates, midpoint coordinates and end point coordinates of the circular arc path according to the midpoint posture, the initial posture of the robotic arm end, the target posture of the robotic arm end and the radius of the circular arc path; calculating the coordinates of the circular arc path according to the center coordinates, starting point coordinates, midpoint coordinates and end point coordinates of the circular arc path; calculating the motion trajectory of the robotic arm end according to the coordinates of the circular arc path, the initial posture and target posture of the robotic arm end.

[0011] On the other hand, a humanoid robot arm-claw cooperative control device is provided, including: a first acquisition unit, which acquires the motion type of the robotic arm, the initial position and target position of the end of the robotic arm; a first calculation unit, which calculates the angles of each joint of the robotic arm during the motion according to the motion type of the robotic arm, the initial position, target position, initial speed and target speed of the end of the robotic arm; a second acquisition unit, which acquires the trigger type, trigger time, end time, initial position, target position, initial speed and target speed of the dexterous gripper; a second calculation unit, which calculates the motion trajectory of the dexterous gripper according to the trigger type, trigger time, end time, initial position, target position, initial speed and target speed of the dexterous gripper; a control unit, which synchronously controls the motion of the robotic arm and the dexterous gripper of the robot according to the angles of each joint of the robotic arm and the motion trajectory of the dexterous gripper during the motion.

[0012] On the other hand, an electronic device is provided, comprising: a processor and a memory for storing executable instructions of the processor; wherein the processor is configured to execute the above-mentioned arm-claw collaborative control method.

[0013] On the other hand, a computer-readable storage medium is provided, in which at least one instruction, at least one program, code set or instruction set is stored, and the at least one instruction, at least one program, code set or instruction set is loaded and executed by a processor to implement the above-mentioned arm-claw collaborative control method.

[0014] It can be seen from the analysis that the present invention discloses a method, device, equipment and medium for the coordinated control of the arm and claw of a humanoid robot. The present invention regards the mechanical arm and the dexterous gripper as a whole, integrates the motion control of the mechanical arm and the dexterous gripper, and designs the motion control instructions of the arm and claw system. In the scene where the coordinated control of the arm and claw is required, it is not necessary to separate the motion of the mechanical arm and the dexterous gripper and control them separately. The motion of the mechanical arm and the dexterous gripper can be associated, and the motion of the two can be controlled with a common time axis. It can reduce the complexity of programming of the arm and claw coordinated scene, improve the flexibility of the arm and claw coordinated control, and enhance work efficiency. BRIEF DESCRIPTION OF THE DRAWINGS

[0015] The drawings constituting a part of the present application are used to provide a further understanding of the present invention. The exemplary embodiments of the present invention and their descriptions are used to explain the present invention and do not constitute an improper limitation of the present invention. Among them:

[0016] Figure 1 This is a timing diagram of the arm-claw system control in the prior art.

[0017] Figure 2 FIG. 4 is a control timing diagram of an arm-claw system according to an embodiment of the present invention.

[0018] Figure 3 FIG. 4 is a control flow chart of an embodiment of the present invention.

[0019] Figure 4 Schematic diagram of an arm claw control method according to an embodiment of the present invention. Figure 5 FIG. 4 is a schematic diagram of an arc trajectory according to an embodiment of the present invention. DETAILED DESCRIPTION

[0020] The present invention will be described in detail below with reference to the accompanying drawings and in conjunction with embodiments. Each example is provided by way of explanation of the present invention and does not limit the present invention. In fact, it will be clear to those skilled in the art that modifications and variations may be made in the present invention without departing from the scope or spirit of the present invention. For example, a feature shown or described as a part of one embodiment may be used in another embodiment to produce yet another embodiment. Therefore, it is desired that the present invention encompasses such modifications and variations within the scope of the appended claims and their equivalents.

[0021] One or more examples of the present invention are shown in the accompanying drawings. The detailed description uses numbers and letter labels to refer to features in the drawings. Like or similar labels in the drawings and description have been used to refer to like or similar parts of the present invention. As used herein, the terms "first", "second", "third", and "fourth", etc. are used interchangeably to distinguish one component from another and are not intended to indicate the location or importance of individual components.

[0022] like Figure 2-Figure 4 As shown, according to an embodiment of the present invention, a method for coordinated control of an arm and claw of a humanoid robot is provided, comprising the following steps:

[0023] Step S101, obtaining the motion type of the robotic arm, the initial posture and target posture of the end of the robotic arm;

[0024] The motion types of the above-mentioned robotic arm include linear motion, circular motion and mixed motion; linear motion is that the end of the robotic arm moves along a straight line path; circular motion is that the end of the robotic arm moves along a circular path; mixed motion is that the end of the robotic arm moves in the order of straight line path, circular path, and straight line path, and during the circular motion, the trajectory of the straight line path is tangent to the trajectory of the circular path.

[0025] The initial position and target position of the end of the robotic arm are estimated by a visual algorithm or directly input by humans.

[0026] Step S102, calculating the angles of each joint of the robotic arm during the movement according to the movement type of the robotic arm, the initial posture and target posture of the end of the robotic arm;

[0027] The above-mentioned method of calculating the angles of each joint of the robotic arm during the movement according to the movement type of the robotic arm, the initial position and target position of the end of the robotic arm includes: calculating the movement trajectory of the end of the robotic arm according to the movement type of the robotic arm, the initial position and target position of the end of the robotic arm; converting the movement trajectory of the end of the robotic arm into the angles of each joint of the robotic arm during the movement.

[0028] The parametric description of a trajectory is usually expressed by trajectory parameters:

[0029] p=p(u)u∈[u min ,u max ](1)

[0030] Among them, u is the motion trajectory parameter of the end of the robotic arm, u min and u max are the trajectory parameters of the end of the robot arm in the initial position and the target position respectively. The trajectory is determined by the trajectory parameters and is a function of the trajectory parameters. The trajectory parameter u is a function of time, that is, u = u(t). The motion trajectory p represents the change curve of u(t) in a certain interval.

[0031] When the motion trajectory is a linear motion, given the initial position p(0) and the target position p(1) of the end of the robot, the motion trajectory p is expressed by the equation:

[0032] p=p(0)+(p(1)-p(0))uu∈[0,1](2)

[0033] Wherein, u represents the path parameter.

[0034] When the motion type of the robot arm is mixed motion, calculating the motion trajectory of the robot arm end according to the motion type, initial posture and motion target of the robot arm includes: obtaining the midpoint posture between the initial posture and target posture of the robot arm end; obtaining the radius of the arc path; calculating the center coordinates, starting point coordinates, midpoint coordinates and end point coordinates of the arc path according to the midpoint position, the initial posture of the robot arm end, the target posture of the robot arm end and the radius of the arc path; calculating the coordinates of the arc path according to the center coordinates, starting point coordinates, midpoint coordinates and end point coordinates of the arc path; calculating the motion trajectory of the robot arm end according to the coordinates of the arc path, the initial posture and target posture of the robot arm end; wherein the midpoint posture is the posture of the intersection of the extension lines of the initial posture and target posture of the robot arm end along the motion direction.

[0035] Specifically, Figure 5 As shown, assuming that the end of the robot arm is in the initial position P k-1 Point starts the movement, the middle point is P k Point, and then reach the target pose P k+1 Point. For P k The point adopts the form of arc transition, P s Point is the starting point for the transition from the straight line path to the circular arc path, P e It is the end point of the transition from the arc path to the straight line path. s P s The velocity of the point, V e P e The speed of the point, in order to ensure the smoothness and stability of the transition, P e Click to P k The length of the point and P s Click to P k-1 The lengths of the points are equal, P s Click to P e The linear velocity of the circular arc path of the point remains unchanged, the radius r of the circular arc path is given in advance, the arc length is l = theta*r, theta = π-α, α is the angle between the two straight line paths.

[0036] The specific formula derivation process is as follows: and The angle between them is α,

[0037]

[0038] Therefore, the arc length l is:

[0039] l=(π-α)r(4)

[0040] From the geometric relationship, we can get:

[0041]

[0042] From this we can calculate point p s The coordinates are:

[0043]

[0044] Similarly, we can find the point p e The coordinates of .

[0045]

[0046] Remember p c Point is p s and p e The midpoint of the arc, o is the center of the arc path:

[0047]

[0048] From the geometric relationship:

[0049]

[0050] so:

[0051]

[0052] That is to obtain the coordinates of the center of the circle:

[0053]

[0054] The arc path reasoning process is then used to calculate the coordinates of points on the arc path.

[0055] After the path is generated, the pose in the task space is obtained. It is necessary to convert the pose in the task space into the angle in the robot arm joint space, that is, the inverse kinematics of the robot arm:

[0056] q=inverse(M target )(12)

[0057] Among them, M target is the target position of the end of the robot arm, and q is the joint angle corresponding to the target position. It can be solved by numerical method, and the solution process is as follows:

[0058] The kinematic equation of the robot arm is:

[0059] x=f(q)(13)

[0060] Where x represents the end position of the robot arm.

[0061] According to the initial position of each joint angle q init , Taylor expansion of the kinematic equation can give the end velocity x of the robot arm d ,Right now

[0062]

[0063] Where q d represents the desired joint angle. Preserving the first order can be simplified to:

[0064]

[0065] Right now

[0066] x d -f(q init )=J(q init )Δq(16)

[0067] so

[0068] Δq=J -1 (q init )(x d -f(q init )(17)

[0069] The inverse solution is obtained by numerical iteration, namely:

[0070] q k+1 =q k +J -1 (q init )(x d -f(q init )(18)

[0071] Among them, q k+1 represents the joint angle after the kth iteration of the inverse solution algorithm, q k Represents the joint angle after the k-1th iteration of the inverse solution algorithm.

[0072] Step S103, obtaining the triggering conditions, initial posture, target posture, initial speed and target speed of the dexterous gripper;

[0073] The trigger conditions of the above-mentioned dexterous gripper include trigger type, trigger time, end time, trigger distance and end distance. The trigger type includes time trigger and distance trigger. Time trigger triggers the movement of the dexterous gripper after a set time has passed since the start of operation. Distance trigger triggers the movement of the dexterous gripper after a set distance has passed since the start of operation.

[0074] Specifically, the trajectory of the six joints of the dexterous gripper is planned, and the joint trajectory is expressed by the following equation:

[0075] θ=θ(t x ) (19)

[0076] For each finger, there is:

[0077] θ i =θ i (t x ) (20)

[0078] In order to ensure the velocity continuity of the joints at different motion stages, a cubic polynomial trajectory can be used:

[0079] θ(t)=a0+a1(t x -t s )+a2(t x -t s ) 2 +a3(t x -t s ) 3 (twenty one)

[0080] The parameters a0, a1, a2, and a3 are determined by the following formula:

[0081]

[0082] where t s is the triggering time of the dexterous gripper, t x is the arm-claw coordinated motion time, T h represents the total time of the dexterous gripper movement, θ init is the initial position of the joint, h represents θ target -θ init ,v init is the initial velocity of the joint, v final is the target speed of the joint, the trajectory is segmented, and when the finger is in motion, after the speed changes, the cubic polynomial planning is still used. At this time, the joint position θ of the finger is obtained k and joint velocity v k The target position is θ target , the position and speed at this moment are used as planning constraints, and the target position is used as the end position for trajectory planning. To ensure the continuity of speed, this application only describes one planning method, but is not limited to this.

[0083] Step S104, calculating the motion trajectory of the dexterous gripper according to the triggering condition, initial position, target position, initial speed and target speed of the dexterous gripper;

[0084] Step S105, synchronously controlling the movement of the robot's mechanical arm and the dexterous gripper according to the angles of the joints of the mechanical arm and the movement trajectory of the dexterous gripper during the movement.

[0085] Specifically, when the trigger type of the dexterous gripper is time trigger:

[0086] The robot arm starts to move at time t = t0. eAt the end of the moment, at the moment t1, the dexterous gripper starts to move from the joint angle θ0 to the target position θ1. The movement time of the dexterous gripper is from t1 to t2, and the speed is from v0 at the beginning to v1 at the end. Therefore, the input parameters of the trajectory of the dexterous gripper are:

[0087] {θ0θ1v0v1t1t2}(23)

[0088] The motion trajectory of the dexterous gripper can be described as:

[0089] θ=θ(t),t∈(t1,t2)(24)

[0090] The trajectory of the arm claw is:

[0091]

[0092] Where q is the changing function of the joint angles of the robotic arm and time t, and θ is the changing function of the joint angles of the dexterous gripper and time t. The robotic arm and the dexterous gripper follow the same time t, which is the basis for the coordinated motion of the arm and gripper.

[0093] When the trigger mode is distance trigger:

[0094] Taking linear motion as an example, for formula (2), the trajectory parameter u adopts T-type trajectory planning to ensure stability, that is,

[0095]

[0096] Among them, T a Indicates the acceleration phase time, T d Indicates the deceleration phase time, t start Indicates the time when the robot arm starts moving, t end is the time when the end of the robot arm reaches the target position, v const Indicates the speed of the robot during the constant speed phase.

[0097] The expected trajectory duration is preset to T, and the maximum acceleration is a max , we can get T a and T d .

[0098] The speed calculation of the constant speed stage is:

[0099]

[0100] The duration of the acceleration phase is:

[0101]

[0102] The time of the deceleration phase is:

[0103]

[0104] Therefore, the robot moves along the trajectory p(u(t), t e At the end of the moment, at time t1, the movement distance reaches the position where the dexterous gripper starts to move, p = p(u(t1)). Then, the gripper starts to move, and the input trajectory of the gripper is consistent with the delay trigger situation, that is, the movement trajectory:

[0105] θ=θ(t),t∈(t1,t2)(30)

[0106] Robotic arm path length calculation:

[0107] For complex motion paths, the path length can be calculated based on the cycle step length dt controlled by the algorithm. Assume that the motion time of the path is T total , then the number of control cycles corresponding to the control period is:

[0108] n=T total / dt(31)

[0109] The length of the path is:

[0110]

[0111] Wherein, i represents the i-th control cycle.

[0112] After the path calculation is completed, the path s is used to represent the maximum value u of the trajectory parameter max , that is u max =s minimum value is 0; that is, u min = 0. At this point, the arm-claw motion trajectory expressed by equation (25) is solved;

[0113] This method can be used to control the robotic arm and dexterous gripper in time synchronization, so that the robotic arm can move uninterruptedly along a motion trajectory without interruption in the movement of the robotic arm. At the same time, since the robotic arm and the dexterous gripper move based on the same time axis, the control of the overall posture of the robotic arm and the dexterous gripper is more accurate, and there will be no problem of incoordination of the motion trajectory between the robotic arm and the dexterous gripper.

[0114] The present invention also discloses an electronic device, which includes: a processor and a memory for storing executable instructions of the processor; wherein the processor is configured to execute the above-mentioned arm-claw collaborative control method.

[0115] The present invention also discloses an arm-claw cooperative control device of a humanoid robot, comprising: a first acquisition unit, which acquires the motion type of the robotic arm, the initial position and target position of the end of the robotic arm; a first calculation unit, which calculates the angles of each joint of the robotic arm during the motion process according to the motion type of the robotic arm, the initial position, target position, initial speed and target speed of the end of the robotic arm; a second acquisition unit, which acquires the trigger type, trigger time, end time, initial position, target position, initial speed and target speed of the dexterous gripper; a second calculation unit, which calculates the motion trajectory of the dexterous gripper according to the trigger type, trigger time, end time, initial position, target position, initial speed and target speed of the dexterous gripper; a control unit, which synchronously controls the motion of the robotic arm and the dexterous gripper of the robot according to the angles of each joint of the robotic arm and the motion trajectory of the dexterous gripper during the motion process.

[0116] The present invention also discloses a computer-readable storage medium, which stores at least one instruction, at least one program, code set or instruction set, and the at least one instruction, at least one program, code set or instruction set is loaded and executed by a processor to implement the above-mentioned arm-claw collaborative control method.

[0117] Compared with the prior art, the present invention regards the robot arm and the dexterous gripper as a whole, integrates the motion control of the robot arm and the dexterous gripper, and designs the motion control instructions of the arm-claw system. In the scenario where the arm-claw collaborative control is required, it is not necessary to separate the motion of the robot arm and the dexterous gripper and control them separately. The motion of the robot arm and the dexterous gripper can be associated and the motion of the two can be controlled with a common time axis. It can reduce the complexity of programming of the arm-claw collaborative scenario, improve the flexibility of the arm-claw collaborative control, and enhance work efficiency.

[0118] The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention. For those skilled in the art, the present invention may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention shall be included in the protection scope of the present invention.

Claims

1. A method for coordinated control of an arm and claw of a humanoid robot, characterized in that: include: Obtain the motion type of the robotic arm, the initial position and target position of the end of the robotic arm; Calculating the angles of the joints of the robotic arm during the movement according to the movement type of the robotic arm, the initial position, the target position, the initial speed and the target speed of the end of the robotic arm; Obtain the triggering conditions, initial position, target position, initial speed and target speed of the dexterous gripper; Calculating the motion trajectory of the dexterous gripper according to the triggering condition, initial position, target position, initial speed and target speed of the dexterous gripper; The movements of the robot's mechanical arm and the dexterous gripper are synchronously controlled according to the angles of the joints of the mechanical arm and the movement trajectory of the dexterous gripper during the movement.

2. The arm-claw coordinated control method of a humanoid robot according to claim 1, characterized in that: The motion types of the robot arm include linear motion, circular motion and mixed motion; The linear motion is that the end of the robot arm moves along a linear path; The circular motion is that the end of the robot arm moves along a circular path; The mixed motion is that the end of the robot arm moves in the order of a straight path, a circular path, and a straight path, and during the circular motion, the trajectory of the straight path is tangent to the trajectory of the circular path.

3. The arm-claw coordinated control method of a humanoid robot according to claim 2, characterized in that: The calculating of the angles of the joints of the robotic arm during the motion according to the motion type of the robotic arm, the initial posture and the target posture of the end of the robotic arm comprises: Calculating the motion trajectory of the end of the robotic arm according to the motion type of the robotic arm, the initial position and target position of the end of the robotic arm; The motion trajectory of the end of the robotic arm is converted into the angles of each joint of the robotic arm during the motion process.

4. The arm-claw coordinated control method of a humanoid robot according to claim 3, characterized in that: The triggering conditions of the dexterous gripper include trigger type, trigger time, end time, trigger distance and end distance, and the trigger type includes time trigger and distance trigger; The time trigger is to trigger the movement of the dexterous gripper after a set time has passed since the robot arm started running; The distance trigger is when the robot arm triggers the movement of the dexterous gripper after it passes a set distance from the start of operation.

5. The arm-claw coordinated control method of a humanoid robot according to claim 1, characterized in that: The end time of the dexterous gripper is the time after a preset running time has passed since the triggering time of the dexterous gripper.

6. The method for controlling the arm and claw of a humanoid robot according to claim 3, characterized in that: When the motion type of the robotic arm is a mixed motion, calculating the motion trajectory of the end of the robotic arm according to the motion type, the initial posture and the motion target of the robotic arm includes: Obtaining a midpoint pose between an initial pose and a target pose of the end of the robotic arm; Obtaining the radius of the arc path; Calculating the center coordinates, starting point coordinates, midpoint coordinates and end point coordinates of the circular arc path according to the intermediate point posture, the initial posture of the end of the robotic arm, the target posture of the end of the robotic arm and the radius of the circular arc path; Calculating the coordinates of the circular arc path according to the coordinates of the center point, the coordinates of the starting point, the coordinates of the midpoint and the coordinates of the end point of the circular arc path; The motion trajectory of the end of the robotic arm is calculated according to the coordinates of the circular arc path, the initial posture and the target posture of the end of the robotic arm.

7. An arm-claw cooperative control device for a humanoid robot, characterized in that: include: A first acquisition unit acquires the motion type of the robot arm, the initial position and target position of the end of the robot arm; A first calculation unit calculates the angles of the joints of the robotic arm during the movement according to the movement type of the robotic arm, the initial position, target position, initial speed and target speed of the end of the robotic arm; A second acquisition unit acquires the trigger type, trigger time, end time, initial position, target position, initial speed and target speed of the dexterous gripper; a second calculation unit, calculating a motion trajectory of the dexterous gripper according to a trigger type, a trigger time, an end time, an initial position, a target position, an initial speed, and a target speed of the dexterous gripper; A control unit synchronously controls the movement of the robot's mechanical arm and the dexterous gripper according to the angles of the joints of the mechanical arm and the movement trajectory of the dexterous gripper during the movement.

8. An electronic device, characterized in that: The electronic device comprises: a processor and a memory for storing executable instructions of the processor; Wherein, the processor is configured to execute the arm-claw collaborative control method described in any one of claims 1-6.

9. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores at least one instruction, at least one program, code set or instruction set, and the at least one instruction, at least one program, code set or instruction set is loaded and executed by the processor to implement the arm-claw collaborative control method described in any one of claims 1-6.

Citation Information

Patent Citations

  • Robot control method and robot

    CN104742127A

  • Fusion system of mechanical arm and dexterous hand and motion control method

    CN114714327A

  • Scooter, control method of mechanical arm, electronic equipment and storage medium

    CN116038647A

  • Dexterous hand and mechanical arm reinforcement learning cooperative control method based on heuristic trajectory

    CN117733850A

  • Five-finger dexterous arm-hand robot grabbing method based on teaching learning

    CN118238142A

Cited By

  • Robot scheduling method and device, medium and program product

    CN122077621A

  • A robot scheduling method, apparatus, medium, and program product

    CN122077621B