Wrist singular crossing method and device and robot system

By planning and angle compensation for the trajectory of the strange area of ​​the robot’s wrist, the speeding problem when crossing the strange area is solved, and the safety and stability of the robot are improved.

CN118927254APending Publication Date: 2024-11-12GREE ELECTRIC APPLIANCE INC OF ZHUHAI

Patent Information

Application Number
CN202411287447.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-13
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

In the prior art, speeding occurs when crossing the strange area of ​​the wrist, resulting in unstable movement of the robot and safety risks.

Method used

By trajectory planning of the singular area of ​​the wrist of the target robot, the end position error and angular velocity error of multiple interpolation points are calculated, joint angle compensation is performed, the actual interpolation joint angle and angular velocity are obtained, and the robot is controlled to pass through the singular area.

Benefits of technology

It avoids the speeding phenomenon caused by the irreversible Jacques matrix, improves the safety and stability of the robot, and solves the problem of motion inconsistency when crossing the strange area of ​​the wrist.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118927254A_ABST
    Figure CN118927254A_ABST
Patent Text Reader

Abstract

The invention provides a wrist singular crossing method and device and a robot system, and the method comprises the steps: carrying out the trajectory planning of a wrist singular region of a target robot, and obtaining a plurality of interpolation points which are any one point of the wrist singular region; calculating the tail end pose error corresponding to each interpolation point of the singular region of the wrist, wherein the tail end pose error comprises a position error and a rotation angle error; calculating an angular velocity error of each interpolation point according to each tail end pose error, wherein the angular velocity error is an error between a theoretical angular velocity and an actual angular velocity of the interpolation point; compensating the joint angle of the corresponding interpolation point according to each angular velocity error to obtain an actual interpolation joint angle of each interpolation point; and according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each interpolation point, the target robot is controlled to pass through the wrist singular area, and the problem that in the prior art, the overspeed phenomenon occurs when the target robot passes through the wrist singular area is solved.
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, computer-readable storage medium, computer program product and robot system for wrist singular crossing. Background Art

[0002] With the development of economy and the proposal of intelligent manufacturing, the application of robots in various industries in my country is constantly expanding, and the role they play in people's daily production and life is becoming more and more critical. Researching the singular posture of robots can not only improve the accuracy, consistency and stability of robot motion control, but also help expand the scale of domestic robot industry and improve the competitiveness in the international market. Singularity is one of the important indicators for evaluating the kinematic performance of industrial robot mechanisms. Therefore, it is very important to improve the stability and controllability of robots on the basis of ensuring the high precision of robots.

[0003] The robot singular configuration can be roughly divided into the following three categories: wrist singularity, top singularity and extension singularity. Among them, wrist singularity means that when the five-axis joint angle is 0°, the robot Jacobian matrix is ​​irreversible, resulting in serious overspeed of the four-axis and six-axis. This configuration appears in most of the robot's workspace and cannot be avoided by adjusting the robot's workspace like top singularity and extension singularity. Therefore, either adjust the posture of the robot tool or use the singularity crossing algorithm to cross it. Summary of the invention

[0004] The main purpose of the present application is to provide a method, device, computer-readable storage medium, computer program product and robot system for wrist singular crossing, so as to at least solve the problem of overspeeding when crossing the wrist singular area in the prior art.

[0005] In order to achieve the above-mentioned purpose, according to one aspect of the present application, a method for wrist singular crossing is provided, comprising: performing trajectory planning on the wrist singular area of ​​the target robot to obtain multiple interpolation points, wherein the interpolation point is any point in the wrist singular area; calculating the terminal posture error corresponding to each interpolation point in the wrist singular area, wherein the terminal posture error includes a position error and a rotation angle error; calculating the angular velocity error of each interpolation point according to each terminal posture error, wherein the angular velocity error is the error between the theoretical angular velocity and the actual angular velocity of the interpolation point; compensating the joint angle of the corresponding interpolation point according to each angular velocity error to obtain the actual interpolation joint angle of each interpolation point; controlling the target robot to cross the wrist singular area according to the actual interpolation joint angle of each interpolation point, the corresponding joint angular velocity and the corresponding joint angular acceleration.

[0006] Optionally, trajectory planning is performed on the wrist singular region of the target robot to obtain multiple interpolation points, including: controlling the movement of the target robot to determine the wrist singular region parameters of the target robot, the wrist singular region parameters including joint control parameters of the starting point of the wrist singular region, joint control parameters of the end point of the wrist singular region and the crossing time of the wrist singular region, the joint control parameters including joint angle, joint angular velocity and joint angular acceleration; determining the joint angle calculation formula of each point of the wrist singular region according to the wrist singular region parameters, and determining the multiple interpolation points according to the joint angle calculation formula.

[0007] Optionally, the terminal posture error corresponding to each interpolation point in the wrist singular area is calculated, including: a determination step, determining the theoretical coordinates of the target interpolation point in the base coordinate system and the theoretical coordinates of the interpolation point in the terminal coordinate system according to the joint control parameters of the target interpolation point, and the target interpolation point is any one of the interpolation points; a first calibration step, calibrating according to the theoretical coordinates of the target interpolation point in the base coordinate system and the theoretical coordinates of the target interpolation point in the terminal coordinate system to obtain a theoretical rotation matrix and a theoretical displacement matrix; a control step, controlling the movement of the target robot according to the joint control parameters of the target interpolation point, and obtaining the actual coordinates of the target interpolation point in the base coordinate system and the actual coordinates of the target interpolation point in the terminal coordinate system; a second calibration step, Calibrate the target interpolation point according to its actual coordinates in the base coordinate system and the target interpolation point in the terminal coordinate system to obtain an actual rotation matrix and an actual displacement matrix; calculate the difference between the Euler angle corresponding to the theoretical rotation matrix and the Euler angle corresponding to the actual rotation matrix to obtain an angle error vector, calculate the difference between the theoretical displacement matrix and the actual displacement matrix to obtain a position error vector; combine the angle error vector and the position error vector to form the terminal posture error corresponding to the target interpolation point; repeat the determining step, the first calibration step, the controlling step, the second calibration step, the calculating step and the combining step at least once in sequence until the terminal posture errors corresponding to all the interpolation points are obtained.

[0008] Optionally, the angular velocity error of each interpolation point is calculated according to each terminal posture error, including: determining the relative Jacobian matrix corresponding to the interpolation point according to the theoretical rotation matrix and the theoretical displacement matrix of the interpolation point; establishing an inverse kinematics formula according to the relative Jacobian matrix, the dependent variable of the inverse kinematics formula is the angular acceleration vector, the independent variable of the inverse kinematics formula is the terminal posture vector of the target robot, the terminal posture vector includes the moving speed along each coordinate axis of the terminal coordinate system and the rotation speed around each coordinate axis of the terminal coordinate system; substituting each terminal posture error into the inverse kinematics formula to obtain the angular velocity error of each interpolation point.

[0009] Optionally, the joint angle of the corresponding interpolation point is compensated according to each angular velocity error to obtain the actual interpolation joint angle of each interpolation point, including: calculating the product of the angular velocity error of each interpolation point and the corresponding movement time to obtain the compensated joint angle of each interpolation point, wherein the movement time is the time length from the starting point of the wrist singular area to the interpolation point; calculating the sum of the joint angle of each interpolation point and the corresponding compensated joint angle to obtain the actual interpolation joint angle of each interpolation point.

[0010] Optionally, before controlling the target robot to cross the wrist singular area according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each interpolation point, the method further includes: updating the joint angle calculation formula according to the actual interpolation joint angle of each interpolation point to obtain an updated joint angle calculation formula; deriving the updated joint angle calculation formula to calculate the joint angular velocity corresponding to the actual interpolation joint angle of each interpolation point; and performing a second derivative of the updated joint angle calculation formula to calculate the joint angular acceleration corresponding to the actual interpolation joint angle of each interpolation point.

[0011] According to another aspect of the present application, a device for wrist singular crossing is provided, comprising: a planning unit, used to perform trajectory planning on the wrist singular area of ​​a target robot to obtain multiple interpolation points, wherein the interpolation point is any point in the wrist singular area; a first calculation unit, used to calculate the terminal posture error corresponding to each of the interpolation points in the wrist singular area, wherein the terminal posture error includes a position error and a rotation angle error; a second calculation unit, used to calculate the angular velocity error of each of the interpolation points according to each of the terminal posture errors, wherein the angular velocity error is the error between the theoretical angular velocity and the actual angular velocity of the interpolation point; a compensation unit, used to compensate the joint angle of the corresponding interpolation point according to each of the angular velocity errors to obtain the actual interpolation joint angle of each of the interpolation points; and a control unit, used to control the target robot to cross the wrist singular area according to the actual interpolation joint angle of each of the interpolation points, the corresponding joint angular velocity and the corresponding joint angular acceleration.

[0012] According to another aspect of the present application, a computer-readable storage medium is provided, wherein the computer-readable storage medium includes a stored program, wherein when the program is executed, the device where the computer-readable storage medium is located is controlled to execute any one of the methods described.

[0013] According to another aspect of the present application, a computer program product is provided, comprising a computer program, wherein when the computer program is executed by a processor, any one of the methods described above is implemented.

[0014] According to another aspect of the present application, a robot system is provided, comprising: at least one robot, one or more processors, a memory, and one or more programs, wherein the one or more programs are stored in the memory and are configured to be executed by the one or more processors, and the one or more programs include methods for executing any one of the methods described.

[0015] By applying the technical solution of the present application, in the method of the above-mentioned wrist singular crossing, trajectory planning is performed on the wrist singular area of ​​the target robot to obtain multiple interpolation points, and the terminal posture error corresponding to each interpolation point is calculated. The angular velocity error of each interpolation point is calculated according to the terminal posture error, so that the joint angle of the corresponding interpolation point is compensated according to each angular velocity error to obtain the actual interpolation joint angle of each interpolation point. The actual error can be compensated, and the target robot can be controlled to cross the wrist singular area according to the actual interpolation joint angle of each interpolation point, the corresponding joint angular velocity and the corresponding joint angular acceleration. The robot can cross the wrist singularity normally without the need for reversible operation of the Jacobian matrix, which avoids the serious overspeed phenomenon of the axis when crossing the wrist singular area due to the irreversibility of the Jacobian matrix, avoids the robot shutdown alarm, improves the safety of the robot, and solves the problem of overspeeding when crossing the wrist singular area in the prior art. BRIEF DESCRIPTION OF THE DRAWINGS

[0016] Figure 1 A hardware structure block diagram of a mobile terminal for executing a wrist singular crossing method provided in an embodiment of the present application is shown;

[0017] Figure 2 A schematic flow chart of a method for performing wrist singular traversal provided according to an embodiment of the present application is shown;

[0018] Figure 3 A schematic diagram of a straight line path through a wrist singularity provided in accordance with an embodiment of the present application is shown;

[0019] Figure 4 A schematic diagram of an interpolated Cartesian trajectory and a fitting error after a fifth-order polynomial+precision compensation is shown according to an embodiment of the present application;

[0020] Figure 5 A schematic diagram of an interpolation joint 1 trajectory after a fifth-order polynomial+precision compensation according to an embodiment of the present application is shown;

[0021] Figure 6 A schematic diagram of an interpolation joint 2 trajectory after a fifth-order polynomial+precision compensation according to an embodiment of the present application is shown;

[0022] Figure 7 A schematic diagram of the interpolation joint 3 trajectory after a fifth-order polynomial+precision compensation according to an embodiment of the present application is shown;

[0023] Figure 8 A schematic diagram of a trajectory of an interpolated joint 4 after a fifth-order polynomial+precision compensation according to an embodiment of the present application is shown;

[0024] Fig. 9 A schematic diagram of a trajectory of an interpolated joint 5 after a fifth-order polynomial+precision compensation according to an embodiment of the present application is shown;

[0025] Fig.10 A schematic diagram of a trajectory of an interpolated joint 6 after a fifth-order polynomial+precision compensation according to an embodiment of the present application is shown;

[0026] Fig.11 A schematic flow chart of another method for performing wrist singular traversal provided according to an embodiment of the present application is shown;

[0027] Fig.12 A structural block diagram of a device for performing wrist singular crossing provided according to an embodiment of the present application is shown.

[0028] The above drawings include the following reference numerals:

[0029] 102, processor; 104, memory; 106, transmission device; 108, input and output devices. DETAILED DESCRIPTION

[0030] It should be noted that, in the absence of conflict, the embodiments and features in the embodiments of the present application can be combined with each other. The present application will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.

[0031] In order to enable those skilled in the art to better understand the solution of the present application, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present application.

[0032] It should be noted that the terms "first", "second", etc. in the specification and claims of the present application and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequential order. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present application described here. In addition, the terms "including" and "having" and any of their variations are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device comprising a series of steps or units is not necessarily limited to those steps or units clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.

[0033] For the convenience of description, some nouns or terms involved in the embodiments of the present application are explained below:

[0034] Wrist singularity region: A line segment region on the linear motion path of the robot end where the distance from the singularity point is less than a predetermined threshold.

[0035] As introduced in the background technology, in the prior art, overspeeding occurs when crossing the wrist singularity area. To solve this technical problem, the embodiments of the present application provide a method, device, computer-readable storage medium, computer program product and robot system for crossing the wrist singularity area.

[0036] The technical solutions in the embodiments of the present invention will be described clearly and completely below in conjunction with the accompanying drawings in the embodiments of the present invention.

[0037] The method embodiments provided in the embodiments of the present application can be executed in a mobile terminal, a computer terminal or a similar computing device. Taking running on a mobile terminal as an example, Figure 11 is a hardware structure block diagram of a mobile terminal for a wrist singular crossing method according to an embodiment of the present invention. Figure 1 As shown, the mobile terminal may include one or more ( Figure 1 Only one is shown in the figure) a processor 102 (the processor 102 may include but is not limited to a processing device such as a microprocessor MCU or a programmable logic device FPGA) and a memory 104 for storing data, wherein the mobile terminal may also include a transmission device 106 and an input / output device 108 for communication functions. It can be understood by those skilled in the art that Figure 1 The structure shown is only for illustration and does not limit the structure of the mobile terminal. Figure 1 More or fewer components as shown, or with Figure 1 Different configurations shown.

[0038] The memory 104 can be used to store computer programs, for example, software programs and modules of application software, such as the computer program corresponding to the method of wrist singular crossing in the embodiment of the present invention. The processor 102 executes various functional applications and data processing by running the computer program stored in the memory 104, that is, to implement the above method. The memory 104 may include a high-speed random access memory, and may also include a non-volatile memory, such as one or more magnetic storage devices, flash memory, or other non-volatile solid-state memory. In some examples, the memory 104 may further include a memory remotely arranged relative to the processor 102, and these remote memories can be connected to the mobile terminal via a network. Examples of the above network include but are not limited to the Internet, corporate intranets, local area networks, mobile communication networks and combinations thereof. The transmission device 106 is used to receive or send data via a network. The above network specific examples may include a wireless network provided by a communication provider of the mobile terminal. In one example, the transmission device 106 includes a network adapter (Network Interface Controller, referred to as NIC), which can be connected to other network devices through a base station so as to communicate with the Internet. In one example, the transmission device 106 may be a radio frequency (RF) module, which is used to communicate with the Internet wirelessly.

[0039] In this embodiment, a method for wrist singular crossing running on a mobile terminal, a computer terminal or a similar computing device is provided. It should be noted that the steps shown in the flowchart of the accompanying drawings can be executed in a computer system such as a set of computer executable instructions, and although a logical order is shown in the flowchart, in some cases, the steps shown or described can be executed in an order different from that shown here.

[0040] Figure 2 FIG. 1 is a flow chart of a method for wrist singular crossing according to an embodiment of the present application. Figure 2 As shown, the method comprises the following steps:

[0041] Step S201, performing trajectory planning on the wrist singular region of the target robot to obtain a plurality of interpolation points, where the interpolation point is any point in the wrist singular region;

[0042] Step S202, calculating the terminal posture error corresponding to each of the interpolation points in the wrist singular area, wherein the terminal posture error includes a position error and a rotation angle error;

[0043] Step S203, calculating the angular velocity error of each of the interpolation points according to each of the terminal posture errors, where the angular velocity error is the error between the theoretical angular velocity and the actual angular velocity of the interpolation point;

[0044] Step S204, compensating the joint angle of the corresponding interpolation point according to each of the angular velocity errors to obtain the actual interpolation joint angle of each of the interpolation points;

[0045] Step S205 , controlling the target robot to pass through the wrist singular area according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each of the interpolation points.

[0046] In the above-mentioned method of wrist singular crossing, trajectory planning is performed on the wrist singular area of ​​the target robot to obtain multiple interpolation points, and the terminal posture error corresponding to each interpolation point is calculated. The angular velocity error of each interpolation point is calculated based on the terminal posture error, so that the joint angle of the corresponding interpolation point is compensated according to each angular velocity error to obtain the actual interpolation joint angle of each interpolation point. The actual error can be compensated, and the target robot can be controlled to cross the above-mentioned wrist singular area according to the actual interpolation joint angle of each interpolation point, the corresponding joint angular velocity and the corresponding joint angular acceleration. The robot can cross the wrist singularity normally without the need for reversible operation of the Jacobian matrix, which avoids the serious overspeed phenomenon of the axis when crossing the wrist singular area due to the irreversibility of the Jacobian matrix, avoids the robot shutdown alarm, improves the safety of the robot, and solves the problem of overspeeding when crossing the wrist singular area in the prior art.

[0047] In order to realize theoretical path planning, in an optional implementation manner, the above step S201 includes:

[0048] Step S2011, controlling the target robot to move to determine wrist singular region parameters of the target robot, wherein the wrist singular region parameters include joint control parameters of the starting point of the wrist singular region, joint control parameters of the end point of the wrist singular region and the crossing time of the wrist singular region, wherein the joint control parameters include joint angle, joint angular velocity and joint angular acceleration;

[0049] Step S2012, determining a joint angle calculation formula for each point in the wrist singular region according to the wrist singular region parameters, and determining a plurality of interpolation points according to the joint angle calculation formula.

[0050] In the above embodiment, the starting and ending points A and D of the wrist singular straight line trajectory are taught. For example, the joint angle corresponding to point A is [15, 20, 20, 60, -25, 80], and the joint angle corresponding to point D is [10, 28, 28, 10, 60, 30]. Figure 3 As shown, the crossing time t of the singular area is obtained based on the wrist singular threshold f as well as Figure 3 The joint angle, joint angular velocity and joint angular acceleration of the starting point B of the mid-wrist singular region and the end point C of the wrist singular region are θ b , Substitute the parameters of points B and C in step 2 into the fifth-order polynomial expression theta(t): theta(t) = a0+a1t+a2t 2 +a3t 3 +a4t 4 +a5t 5 , The coefficients a0, a1, a2, a3, a4 and a5 can be calculated. The joint angle calculation formula theta(t) is obtained. f By selecting t between them, we can get the interpolation points corresponding to multiple joint angles. Both the joint angular velocity and the joint angular acceleration can be obtained by derivation of the joint angles.

[0051] In order to calculate the terminal posture error, in an optional implementation, the above step S202 includes:

[0052] Step S2021, a determination step, determining the theoretical coordinates of the target interpolation point in the base coordinate system and the theoretical coordinates of the interpolation point in the terminal coordinate system according to the joint control parameters of the target interpolation point, the target interpolation point being any one of the interpolation points;

[0053] Step S2022, a first calibration step, calibrating according to the theoretical coordinates of the target interpolation point in the base coordinate system and the theoretical coordinates of the target interpolation point in the terminal coordinate system to obtain a theoretical rotation matrix and a theoretical displacement matrix;

[0054] Step S2023, a control step, controlling the movement of the target robot according to the joint control parameters of the target interpolation point to obtain the actual coordinates of the target interpolation point in the base coordinate system and the actual coordinates of the target interpolation point in the terminal coordinate system;

[0055] Step S2024, a second calibration step, calibrating according to the actual coordinates of the target interpolation point in the base coordinate system and the actual coordinates of the target interpolation point in the terminal coordinate system to obtain an actual rotation matrix and an actual displacement matrix;

[0056] Step S2025, a calculation step, calculating the difference between the Euler angle corresponding to the theoretical rotation matrix and the Euler angle corresponding to the actual rotation matrix to obtain an angle error vector, and calculating the difference between the theoretical displacement matrix and the actual displacement matrix to obtain a position error vector;

[0057] Step S2026, a combining step, combining the angle error vector and the position error vector into the terminal position error corresponding to the target interpolation point;

[0058] Step S2027, repeat the above-mentioned determination step, the above-mentioned first calibration step, the above-mentioned control step, the above-mentioned second calibration step, the above-mentioned calculation step and the above-mentioned combination step at least once in sequence until the above-mentioned terminal posture errors corresponding to all the above-mentioned interpolation points are obtained.

[0059] In the above implementation, the forward kinematics module is introduced to calculate the matrix Calculate the robot end position corresponding to the joint angle of each interpolation point And the robot end position corresponding to the actual linear interpolation Compare and get the terminal pose error The calculation process is as follows:

[0060]

[0061] in, represents the transfer matrix of the robot end relative to the base, represents the transfer matrix of robot 1 axis relative to the base, Represents the transfer matrix of robot axis 2 relative to axis 1, and so on; and It is used to describe the posture of the robot end relative to the base. The matrix composed of it is the rotation matrix R; that is, R 理论 is the theoretical rotation matrix, R 实际 is the actual rotation matrix, The displacement matrix used to describe the spatial position of the robot end relative to the base is is the theoretical displacement matrix, is the actual displacement matrix. Position error vector Angular error vector [deta_alphy deta_beta deta_gamma] = (R 理论 -R 实际 ) zyx , where the subscript zyx refers to the process of converting the rotation matrix into the zyx Euler angle, and the terminal posture error

[0062] The terminal pose errors corresponding to all interpolation points are calculated using the above method.

[0063] In order to convert the error in the machine space into the error in the joint space, in an optional implementation, the above step S203 includes:

[0064] Step S2031, determining the relative Jacobian matrix corresponding to the interpolation point according to the theoretical rotation matrix and the theoretical displacement matrix of the interpolation point;

[0065] Step S2032, establishing an inverse kinematics formula according to the relative Jacobian matrix, wherein the dependent variable of the inverse kinematics formula is the angular acceleration vector, and the independent variable of the inverse kinematics formula is the terminal pose vector of the target robot, wherein the terminal pose vector includes the moving speed along each coordinate axis of the terminal coordinate system and the rotation speed around each coordinate axis of the terminal coordinate system;

[0066] Step S2033, substituting each of the above-mentioned terminal posture errors into the above-mentioned inverse kinematics formula to obtain the above-mentioned angular velocity error of each of the above-mentioned interpolation points.

[0067] In the above embodiment, based on the transfer matrix between the robot links Compute the relative Jacobian matrix, Perform SVD decomposition on the base Jacobian matrix J, J = U*S*V T , combined with the damped least squares algorithm, the damping coefficient λ is introduced, and compensate_pos(t) is substituted into the inverse kinematics formula to obtain the required compensated joint angle compensate_joint(t). The inverse kinematics formula is: The dependent variable of the inverse kinematics formula is the angular acceleration vector The independent variable of the above inverse kinematics formula is the terminal pose vector of the above target robot λ is the damping coefficient, σ1,σ2...,σ m are the singular values ​​of J, the elements on the diagonal of the S matrix; U i 、V iThey are the left and right singular vectors of the base Jacobian matrix J, that is, the i-th column vectors of the U matrix and the V matrix, respectively, 1≤i≤m, and m is the number of robot joint axes.

[0068] In order to reduce the error between the theoretical planned path and the actual path, in an optional implementation, the above step S204 includes:

[0069] Step S2041, calculating the product of the angular velocity error and the corresponding movement time of each interpolation point to obtain the compensated joint angle of each interpolation point, wherein the movement time is the time length from the starting point of the wrist singular area to the interpolation point;

[0070] Step S2042, calculating the sum of the joint angle of each interpolation point and the corresponding compensation joint angle to obtain the actual interpolation joint angle of each interpolation point.

[0071] In the above implementation, the joint angular velocity compensate_joint(t) is compensated to theta(t), and the actual interpolated joint angle is obtained as actual_theta(t), actual_theta(t)=theta(t)+compensate_joint(t)*t, and the above actual interpolated joint angle of each interpolation point can be obtained.

[0072] In order to achieve singular crossing, in an optional implementation, before controlling the target robot to cross the wrist singular area according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each interpolation point, the method further includes:

[0073] Step S301, updating the joint angle calculation formula according to the actual interpolated joint angle of each interpolation point to obtain an updated joint angle calculation formula;

[0074] Step S302, deriving the updated joint angle calculation formula to calculate the joint angular velocity corresponding to the actual interpolation joint angle of each interpolation point;

[0075] Step S303, performing a second derivative on the updated joint angle calculation formula to calculate the joint angle acceleration corresponding to the actual interpolation joint angle of each interpolation point.

[0076] In the above implementation, in order to control the robot joint movement, the actual interpolated joint angles are available, and the corresponding joint angular velocity and joint acceleration must be calculated. After the joint angle calculation formula is updated by the actual interpolated joint angles, the corresponding joint angular velocity and joint acceleration can be obtained by performing first and second derivatives respectively, so as to perform joint control later when crossing the singular area.

[0077] What you need to explain is that the fifth-order polynomial combined with the precision compensation algorithm is verified and the data is analyzed, such as Figure 4 As shown in the figure, the theoretical interpolation path, the actual interpolation path and the fitting error are drawn respectively. It can be seen that the maximum fitting error is less than 0.02mm, which meets the requirements for path interpolation accuracy. Figures 5 to 10 The interpolation trajectories of joints 1 to 6 corresponding to the actual interpolation path are shown. It can be seen that all joints can move smoothly from the starting point to the end point, and the speed, acceleration and agility of each joint are within the limit. Agility is the rate of change of acceleration.

[0078] In order to enable those skilled in the art to more clearly understand the technical solution of the present application, the implementation process of the method for wrist singular crossing of the present application will be described in detail below in conjunction with specific embodiments.

[0079] This embodiment relates to a specific method of wrist singular crossing, such as Fig.11 As shown, the following steps are included:

[0080] Step 1: Teach the starting and ending points of the wrist singular straight line trajectory;

[0081] Step 2: Look ahead to this trajectory and obtain the total interpolation time t of the singular region based on the wrist singular threshold f as well as Figure 3 The joint angle, joint angular velocity and joint angular acceleration at points B and C;

[0082] Step 3: Substitute the parameters of points B and C in step 2 into the fifth-order polynomial expression theta(t) to obtain the coefficients of the polynomial. Use the fifth-order polynomial to plan the joint space trajectory for the singular area.

[0083] theta(t)=a0+a1t+a2t 2 +a3t 3 +a4t 4 +a5t 5

[0084] Step 4: Introduce the forward kinematics module, calculate the end pose corresponding to the joint angle of each interpolation point in step 3, and compare it with the actual straight line trajectory to obtain the end pose error compensate_pos(t);

[0085] Step 5: Based on the transfer matrix between the links, the relative Jacobian matrix can be calculated T J;

[0086] Step 6: Based on the conversion relationship between the relative Jacobian matrix and the base Jacobian matrix, the base Jacobian matrix J can be calculated;

[0087] Step 7: Perform SVD decomposition on the base Jacobian matrix;

[0088] Step 8: Combine the damped least squares algorithm, introduce the damping coefficient λ, and substitute it into the formula q* to obtain the required compensated joint angle compensate_joint(t);

[0089]

[0090] Step 9: Compensate the joint angle compensated_joint(t) calculated in step 8 to theta(t) in step 3 to obtain the actual interpolated joint angle actuall_theta(t), that is, actual_theta(t)=theta(t)+compensate_joint(t).

[0091] It should be noted that the steps shown in the flowcharts of the accompanying drawings can be executed in a computer system such as a set of computer executable instructions, and that, although a logical order is shown in the flowcharts, in some cases, the steps shown or described can be executed in an order different from that shown here.

[0092] The embodiment of the present application also provides a device for wrist singular crossing. It should be noted that the device for wrist singular crossing of the embodiment of the present application can be used to execute the method for wrist singular crossing provided by the embodiment of the present application. The device is used to implement the above-mentioned embodiments and preferred implementation modes, and the descriptions that have been made will not be repeated. As used below, the term "module" can implement a combination of software and / or hardware for a predetermined function. Although the device described in the following embodiments is preferably implemented in software, the implementation of hardware, or a combination of software and hardware, is also possible and conceivable.

[0093] The following is an introduction to the wrist singular crossing device provided in the embodiments of the present application.

[0094] Fig.12 is a structural block diagram of a device for wrist singular crossing according to an embodiment of the present application. Fig.12 As shown, the device comprises:

[0095] A planning unit 10 is used to perform trajectory planning on the wrist singular region of the target robot to obtain a plurality of interpolation points, where the interpolation point is any point in the wrist singular region;

[0096] A first calculation unit 20 is used to calculate the terminal posture error corresponding to each of the above interpolation points in the above wrist singular area, and the above terminal posture error includes a position error and a rotation angle error;

[0097] A second calculation unit 30 is used to calculate the angular velocity error of each of the interpolation points according to each of the terminal posture errors, where the angular velocity error is the error between the theoretical angular velocity and the actual angular velocity of the interpolation point;

[0098] A compensation unit 40, used to compensate the joint angle of the corresponding interpolation point according to each of the angular velocity errors to obtain an actual interpolation joint angle of each of the interpolation points;

[0099] The control unit 50 is used to control the target robot to pass through the wrist singular area according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each of the interpolation points.

[0100] In the above-mentioned device for wrist singular crossing, trajectory planning is performed on the wrist singular area of ​​the target robot to obtain multiple interpolation points, and the terminal posture error corresponding to each interpolation point is calculated. The angular velocity error of each interpolation point is calculated based on the terminal posture error, so that the joint angle of the corresponding interpolation point is compensated according to each angular velocity error to obtain the actual interpolation joint angle of each interpolation point. The actual error can be compensated, and the target robot can be controlled to cross the above-mentioned wrist singular area according to the actual interpolation joint angle of each interpolation point, the corresponding joint angular velocity and the corresponding joint angular acceleration. The robot can cross the wrist singularity normally without the need for reversible operation of the Jacobian matrix, which avoids the serious overspeed phenomenon of the axis when crossing the wrist singular area due to the irreversibility of the Jacobian matrix, avoids the robot shutdown alarm, improves the safety of the robot, and solves the problem of overspeeding when crossing the wrist singular area in the prior art.

[0101] In order to realize the theoretical path planning, in an optional implementation manner, the planning unit includes:

[0102] A first determination module is used to control the movement of the target robot to determine wrist singular region parameters of the target robot, wherein the wrist singular region parameters include joint control parameters of the starting point of the wrist singular region, joint control parameters of the end point of the wrist singular region and the crossing time of the wrist singular region, and the joint control parameters include joint angle, joint angular velocity and joint angular acceleration;

[0103] The second determination module is used to determine the joint angle calculation formula of each point in the above-mentioned wrist singular area according to the above-mentioned wrist singular area parameters, and determine the multiple above-mentioned interpolation points according to the above-mentioned joint angle calculation formula.

[0104] In the above embodiment, the starting and ending points A and D of the wrist singular straight line trajectory are taught. For example, the joint angle corresponding to point A is [15, 20, 20, 60, -25, 80], and the joint angle corresponding to point D is [10, 28, 28, 10, 60, 30]. Figure 3As shown, the crossing time t of the singular area is obtained based on the wrist singular threshold f as well as Figure 3 The joint angle, joint angular velocity and joint angular acceleration of the starting point B of the mid-wrist singular region and the end point C of the wrist singular region are θ b , Substitute the parameters of points B and C in step 2 into the fifth-order polynomial expression theta(t): theta(t) = a0+a1t+a2t 2 +a3t 3 +a4t 4 +a5t 5 , The coefficients a0, a1, a2, a3, a4 and a5 can be calculated. The joint angle calculation formula theta(t) is obtained. f By selecting t between them, we can get the interpolation points corresponding to multiple joint angles. Both the joint angular velocity and the joint angular acceleration can be obtained by derivation of the joint angles.

[0105] In order to calculate the terminal posture error, in an optional implementation, the first calculation unit includes:

[0106] A third determination module is used to execute the determination step, and determine the theoretical coordinates of the target interpolation point in the base coordinate system and the theoretical coordinates of the interpolation point in the terminal coordinate system according to the joint control parameters of the target interpolation point, wherein the target interpolation point is any one of the interpolation points;

[0107] A first calibration module is used to execute a first calibration step, and calibrate according to the theoretical coordinates of the target interpolation point in the base coordinate system and the theoretical coordinates of the target interpolation point in the terminal coordinate system to obtain a theoretical rotation matrix and a theoretical displacement matrix;

[0108] A control module, used for the control step, controlling the movement of the target robot according to the joint control parameters of the target interpolation point, and obtaining the actual coordinates of the target interpolation point in the base coordinate system and the actual coordinates of the target interpolation point in the terminal coordinate system;

[0109] A second calibration module is used to execute a second calibration step, and calibrate according to the actual coordinates of the target interpolation point in the base coordinate system and the actual coordinates of the target interpolation point in the terminal coordinate system to obtain an actual rotation matrix and an actual displacement matrix;

[0110] A first calculation module is used to perform a calculation step, calculate the difference between the Euler angle corresponding to the theoretical rotation matrix and the Euler angle corresponding to the actual rotation matrix to obtain an angle error vector, and calculate the difference between the theoretical displacement matrix and the actual displacement matrix to obtain a position error vector;

[0111] A combination module, used to perform the combination step, combining the angle error vector and the position error vector into the terminal position error corresponding to the target interpolation point;

[0112] A repetition module is used to sequentially repeat the above-mentioned determination step, the above-mentioned first calibration step, the above-mentioned control step, the above-mentioned second calibration step, the above-mentioned calculation step and the above-mentioned combination step at least once until the above-mentioned terminal posture errors corresponding to all the above-mentioned interpolation points are obtained.

[0113] In the above implementation, the forward kinematics module is introduced to calculate the matrix Calculate the robot end pose corresponding to the joint angle of each interpolation point And the robot end position corresponding to the actual linear interpolation Compare and get the terminal pose error The calculation process is as follows:

[0114]

[0115] in, represents the transfer matrix of the robot end relative to the base, represents the transfer matrix of robot 1 axis relative to the base, Represents the transfer matrix of robot axis 2 relative to axis 1, and so on; and It is used to describe the posture of the robot end relative to the base. The matrix composed of it is the rotation matrix R; that is, R 理论 is the theoretical rotation matrix, R 实际 is the actual rotation matrix, The displacement matrix used to describe the spatial position of the robot end relative to the base is is the theoretical displacement matrix, is the actual displacement matrix. Position error vector Angular error vector [deta_alphy deta_beta deta_gamma] = (R 理论 -R 实际 ) zyx , where the subscript zyx refers to the process of converting the rotation matrix into the zyx Euler angle, and the terminal posture error

[0116] The terminal pose errors corresponding to all interpolation points are calculated using the above method.

[0117] In order to convert the error in the machine space into the error in the joint space, in an optional implementation manner, the second calculation unit includes:

[0118] A fourth determination module, used for determining a relative Jacobian matrix corresponding to the interpolation point according to the theoretical rotation matrix and the theoretical displacement matrix of the interpolation point;

[0119] An establishment module is used to establish an inverse kinematics formula according to the relative Jacobian matrix, wherein the dependent variable of the inverse kinematics formula is the angular acceleration vector, and the independent variable of the inverse kinematics formula is the terminal posture vector of the target robot, wherein the terminal posture vector includes the moving speed along each coordinate axis of the terminal coordinate system and the rotation speed around each coordinate axis of the terminal coordinate system;

[0120] The second calculation module is used to substitute each of the above-mentioned terminal posture errors into the above-mentioned inverse kinematics formula to obtain the above-mentioned angular velocity error of each of the above-mentioned interpolation points.

[0121] In the above embodiment, based on the transfer matrix between the robot links Compute the relative Jacobian matrix, Perform SVD decomposition on the base Jacobian matrix J, J = U*S*V T , combined with the damped least squares algorithm, the damping coefficient λ is introduced, and compensate_pos(t) is substituted into the inverse kinematics formula to obtain the required compensated joint angle compensate_joint(t). The inverse kinematics formula is: The dependent variable of the inverse kinematics formula is the angular acceleration vector The independent variable of the above inverse kinematics formula is the terminal pose vector of the above target robot λ is the damping coefficient, σ1,σ2...,σ m are the singular values ​​of J, the elements on the diagonal of the S matrix; U i 、V i They are the left and right singular vectors of the base Jacobian matrix J, that is, the i-th column vectors of the U matrix and the V matrix, respectively, 1≤i≤m, and m is the number of robot joint axes.

[0122] In order to reduce the error between the theoretical planned path and the actual path, in an optional implementation manner, the compensation unit includes:

[0123] Step S2041, calculating the product of the angular velocity error and the corresponding movement time of each interpolation point to obtain the compensated joint angle of each interpolation point, wherein the movement time is the time length from the starting point of the wrist singular area to the interpolation point;

[0124] Step S2042, calculating the sum of the joint angle of each interpolation point and the corresponding compensation joint angle to obtain the actual interpolation joint angle of each interpolation point.

[0125] In the above implementation, the joint angular velocity compensate_joint(t) is compensated to theta(t), and the actual interpolated joint angle is obtained as actual_theta(t), actual_theta(t)=theta(t)+compensate_joint(t)*t, and the above actual interpolated joint angle of each interpolation point can be obtained.

[0126] In order to achieve singular crossing, in an optional implementation, before controlling the target robot to cross the wrist singular area according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each interpolation point, the method further includes:

[0127] A third calculation unit is used to update the joint angle calculation formula according to the actual interpolation joint angle of each interpolation point to obtain an updated joint angle calculation formula;

[0128] A fourth calculation unit is used to derive the updated joint angle calculation formula to calculate the joint angular velocity corresponding to the actual interpolation joint angle of each interpolation point;

[0129] The fifth calculation unit is used to perform a second derivative on the updated joint angle calculation formula to calculate the joint angle acceleration corresponding to the actual interpolation joint angle of each of the interpolation points.

[0130] In the above implementation, in order to control the robot joint movement, the actual interpolated joint angles are available, and the corresponding joint angular velocity and joint acceleration must be calculated. After the joint angle calculation formula is updated by the actual interpolated joint angles, the corresponding joint angular velocity and joint acceleration can be obtained by performing first and second derivatives respectively, so as to perform joint control later when crossing the singular area.

[0131] What you need to explain is that the fifth-order polynomial combined with the precision compensation algorithm is verified and the data is analyzed, such as Figure 4 As shown in the figure, the theoretical interpolation path, the actual interpolation path and the fitting error are drawn respectively. It can be seen that the maximum fitting error is less than 0.02mm, which meets the requirements for path interpolation accuracy. Figures 5 to 10 The interpolation trajectories of joints 1 to 6 corresponding to the actual interpolation path are shown. It can be seen that all joints can move smoothly from the starting point to the end point, and the angular velocity, joint angular acceleration and agility of each joint are within the limit. The above-mentioned agility is the joint angular acceleration.

[0132] The above-mentioned wrist singular crossing device includes a processor and a memory, and the above-mentioned planning unit, the first calculation unit, the second calculation unit, the compensation unit and the control unit are all stored in the memory as program units, and the processor executes the above-mentioned program units stored in the memory to realize the corresponding functions. The above-mentioned modules are all located in the same processor; or, the above-mentioned modules are located in different processors in any combination.

[0133] The processor includes a kernel, and the kernel retrieves the corresponding program unit from the memory. One or more kernels can be set, and the problem of overspeeding when crossing the wrist singular area in the prior art is solved by adjusting the kernel parameters.

[0134] The memory may include non-permanent memory in a computer-readable medium, random access memory (RAM) and / or non-volatile memory, such as read-only memory (ROM) or flash RAM, and the memory includes at least one memory chip.

[0135] An embodiment of the present invention provides a computer-readable storage medium, wherein the computer-readable storage medium includes a stored program, wherein when the program is executed, the device where the computer-readable storage medium is located is controlled to execute the method for wrist singular crossing.

[0136] Specifically, the methods of wrist singular crossing include:

[0137] Step S201, performing trajectory planning on the wrist singular region of the target robot to obtain a plurality of interpolation points, where the interpolation point is any point in the wrist singular region;

[0138] Step S202, calculating the terminal posture error corresponding to each of the interpolation points in the wrist singular area, wherein the terminal posture error includes a position error and a rotation angle error;

[0139] Step S203, calculating the angular velocity error of each of the interpolation points according to each of the terminal posture errors, where the angular velocity error is the error between the theoretical angular velocity and the actual angular velocity of the interpolation point;

[0140] Step S204, compensating the joint angle of the corresponding interpolation point according to each of the angular velocity errors to obtain the actual interpolation joint angle of each of the interpolation points;

[0141] Step S205 , controlling the target robot to pass through the wrist singular area according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each of the interpolation points.

[0142] An embodiment of the present invention provides a processor, and the processor is used to run a program, wherein the method of wrist singular crossing is executed when the program is run.

[0143] Specifically, the methods of wrist singular crossing include:

[0144] Step S201, performing trajectory planning on the wrist singular region of the target robot to obtain a plurality of interpolation points, where the interpolation point is any point in the wrist singular region;

[0145] Step S202, calculating the terminal posture error corresponding to each of the interpolation points in the wrist singular area, wherein the terminal posture error includes a position error and a rotation angle error;

[0146] Step S203, calculating the angular velocity error of each of the interpolation points according to each of the terminal posture errors, where the angular velocity error is the error between the theoretical angular velocity and the actual angular velocity of the interpolation point;

[0147] Step S204, compensating the joint angle of the corresponding interpolation point according to each of the angular velocity errors to obtain the actual interpolation joint angle of each of the interpolation points;

[0148] Step S205 , controlling the target robot to pass through the wrist singular area according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each of the interpolation points.

[0149] An embodiment of the present invention provides a robot system, the robot system includes at least one robot, a processor, a memory, and a program stored in the memory and executable on the processor, and when the processor executes the program, at least the following steps are implemented:

[0150] Step S201, performing trajectory planning on the wrist singular region of the target robot to obtain a plurality of interpolation points, where the interpolation point is any point in the wrist singular region;

[0151] Step S202, calculating the terminal posture error corresponding to each of the interpolation points in the wrist singular area, wherein the terminal posture error includes a position error and a rotation angle error;

[0152] Step S203, calculating the angular velocity error of each of the interpolation points according to each of the terminal posture errors, where the angular velocity error is the error between the theoretical angular velocity and the actual angular velocity of the interpolation point;

[0153] Step S204, compensating the joint angle of the corresponding interpolation point according to each of the angular velocity errors to obtain the actual interpolation joint angle of each of the interpolation points;

[0154] Step S205 , controlling the target robot to pass through the wrist singular area according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each of the interpolation points.

[0155] The present application also provides a computer program product, which, when executed on a data processing device, is suitable for executing a program for initializing at least the following method steps:

[0156] Step S201, performing trajectory planning on the wrist singular region of the target robot to obtain a plurality of interpolation points, where the interpolation point is any point in the wrist singular region;

[0157] Step S202, calculating the terminal posture error corresponding to each of the interpolation points in the wrist singular area, wherein the terminal posture error includes a position error and a rotation angle error;

[0158] Step S203, calculating the angular velocity error of each of the interpolation points according to each of the terminal posture errors, where the angular velocity error is the error between the theoretical angular velocity and the actual angular velocity of the interpolation point;

[0159] Step S204, compensating the joint angle of the corresponding interpolation point according to each of the angular velocity errors to obtain the actual interpolation joint angle of each of the interpolation points;

[0160] Step S205 , controlling the target robot to pass through the wrist singular area according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each of the interpolation points.

[0161] Obviously, those skilled in the art should understand that the above modules or steps of the present invention can be implemented by a general computing device, they can be concentrated on a single computing device, or distributed on a network composed of multiple computing devices, they can be implemented by a program code executable by a computing device, so that they can be stored in a storage device and executed by the computing device, and in some cases, the steps shown or described can be executed in a different order than here, 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.

[0162] Those skilled in the art will appreciate that the embodiments of the present application may be provided as methods, systems, or computer program products. Therefore, the present application may adopt the form of a complete hardware embodiment, a complete software embodiment, or an embodiment in combination with software and hardware. Moreover, the present application may adopt the form of a computer program product implemented in one or more computer-usable storage media (including but not limited to disk storage, CD-ROM, optical storage, etc.) that include computer-usable program code.

[0163] The present application is described with reference to the flowcharts and / or block diagrams of the methods, devices (systems), and computer program products according to the embodiments of the present application. It should be understood that each process and / or box in the flowchart and / or block diagram, as well as the combination of the processes and / or boxes in the flowchart and / or block diagram, can be implemented by computer program instructions. These computer program instructions can be provided to a processor of a general-purpose computer, a special-purpose computer, an embedded processor, or other programmable data processing device to generate a machine, so that the instructions executed by the processor of the computer or other programmable data processing device generate instructions for implementing the processes in the flowchart and / or block diagram. Figure 1 A process or multiple processes and / or boxes Figure 1 A device that provides the functions specified in a block or multiple blocks.

[0164] These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing device to operate in a specific manner, so that the instructions stored in the computer-readable memory produce an article of manufacture comprising an instruction device, which implements the process Figure 1 A process or multiple processes and / or boxes Figure 1 A function specified in one or more boxes.

[0165] These computer program instructions can also be loaded onto a computer or other programmable data processing device so that a series of operating steps are executed on the computer or other programmable device to produce a computer-implemented process, thereby providing instructions for implementing the process. Figure 1 A process or multiple processes and / or boxes Figure 1 The steps for the functions specified in one or more boxes.

[0166] In a typical configuration, a computing device includes one or more processors (CPU), input / output interfaces, network interfaces, and memory.

[0167] The memory may include non-permanent memory in a computer-readable medium, random access memory (RAM) and / or non-volatile memory in the form of read-only memory (ROM) or flash RAM. The memory is an example of a computer-readable medium.

[0168] Computer readable media include permanent and non-permanent, removable and non-removable media that can be implemented by any method or technology to store information. Information can be computer readable instructions, data structures, program modules or other data. Examples of computer storage media include, but are not limited to, phase change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM), read-only memory (ROM), electrically erasable programmable read-only memory (EEPROM), flash memory or other memory technology, compact disk read-only memory (CD-ROM), digital versatile disk (DVD) or other optical storage, magnetic cassettes, magnetic tape disk storage or other magnetic storage devices or any other non-transmission media that can be used to store information that can be accessed by a computing device. As defined herein, computer readable media does not include temporary computer readable media (transitory media), such as modulated data signals and carrier waves.

[0169] It should also be noted that the terms "include", "comprises" or any other variations thereof are intended to cover non-exclusive inclusion, so that a process, method, commodity or device including a series of elements includes not only those elements, but also other elements not explicitly listed, or also includes elements inherent to such process, method, commodity or device. In the absence of more restrictions, the elements defined by the sentence "comprises a ..." do not exclude the existence of other identical elements in the process, method, commodity or device including the elements.

[0170] From the above description, it can be seen that the above embodiments of the present application achieve the following technical effects:

[0171] 1) In the wrist singular crossing method of the present application, trajectory planning is performed on the wrist singular area of ​​the target robot to obtain multiple interpolation points, and the terminal posture error corresponding to each interpolation point is calculated. The angular velocity error of each interpolation point is calculated based on the terminal posture error, so that the joint angle of the corresponding interpolation point is compensated according to each angular velocity error to obtain the actual interpolation joint angle of each interpolation point. The actual error can be compensated, and the target robot can be controlled to cross the above-mentioned wrist singular area according to the actual interpolation joint angle of each interpolation point, the corresponding joint angular velocity and the corresponding joint angular acceleration. The robot can cross the wrist singularity normally without the need for reversible operation of the Jacobian matrix, which avoids the serious overspeed phenomenon of the axis when crossing the wrist singular area due to the irreversibility of the Jacobian matrix, avoids the robot shutdown alarm, improves the safety of the robot, and solves the problem of overspeeding when crossing the wrist singular area in the prior art.

[0172] 2) In the device for wrist singular crossing of the present application, trajectory planning is performed on the wrist singular area of ​​the target robot to obtain multiple interpolation points, and the terminal posture error corresponding to each interpolation point is calculated. The angular velocity error of each interpolation point is calculated based on the terminal posture error, so that the joint angle of the corresponding interpolation point is compensated according to each angular velocity error to obtain the actual interpolation joint angle of each interpolation point. The actual error can be compensated, and the target robot can be controlled to cross the above-mentioned wrist singular area according to the actual interpolation joint angle of each interpolation point, the corresponding joint angular velocity and the corresponding joint angular acceleration. The robot can cross the wrist singularity normally without the need for reversible operation of the Jacobian matrix, which avoids the serious overspeeding of the axis when crossing the wrist singular area due to the irreversibility of the Jacobian matrix, avoids the robot shutdown alarm, improves the safety of the robot, and solves the problem of overspeeding when crossing the wrist singular area in the prior art.

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

Claims

1. A method for wrist singular crossing, characterized in that: include: Performing trajectory planning on the wrist singular region of the target robot to obtain a plurality of interpolation points, wherein the interpolation point is any point in the wrist singular region; Calculating the terminal posture error corresponding to each interpolation point in the wrist singular area, wherein the terminal posture error includes a position error and a rotation angle error; Calculating the angular velocity error of each interpolation point according to each terminal posture error, wherein the angular velocity error is the error between the theoretical angular velocity and the actual angular velocity of the interpolation point; Compensating the joint angle of the corresponding interpolation point according to each angular velocity error to obtain the actual interpolation joint angle of each interpolation point; The target robot is controlled to pass through the wrist singular area according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each interpolation point.

2. The method according to claim 1, characterized in that Perform trajectory planning on the singular area of ​​the wrist of the target robot and obtain multiple interpolation points, including: Controlling the target robot to move to determine wrist singular region parameters of the target robot, wherein the wrist singular region parameters include joint control parameters of a starting point of the wrist singular region, joint control parameters of an end point of the wrist singular region, and a crossing time of the wrist singular region, wherein the joint control parameters include joint angle, joint angular velocity, and joint angular acceleration; The joint angle calculation formula of each point in the wrist singular area is determined according to the wrist singular area parameters, and the plurality of interpolation points are determined according to the joint angle calculation formula.

3. The method according to claim 1, characterized in that Calculating the end position and posture errors corresponding to the interpolation points in the wrist singular region, including: A determination step, determining the theoretical coordinates of the target interpolation point in the base coordinate system and the theoretical coordinates of the interpolation point in the terminal coordinate system according to the joint control parameters of the target interpolation point, wherein the target interpolation point is any one of the interpolation points; A first calibration step is to calibrate the target interpolation point according to the theoretical coordinates of the base coordinate system and the theoretical coordinates of the target interpolation point in the terminal coordinate system to obtain a theoretical rotation matrix and a theoretical displacement matrix; A control step, controlling the movement of the target robot according to the joint control parameters of the target interpolation point, to obtain the actual coordinates of the target interpolation point in the base coordinate system and the actual coordinates of the target interpolation point in the terminal coordinate system; A second calibration step is to calibrate according to the actual coordinates of the target interpolation point in the base coordinate system and the actual coordinates of the target interpolation point in the terminal coordinate system to obtain an actual rotation matrix and an actual displacement matrix; The calculation step comprises calculating the difference between the Euler angle corresponding to the theoretical rotation matrix and the Euler angle corresponding to the actual rotation matrix to obtain an angle error vector, and calculating the difference between the theoretical displacement matrix and the actual displacement matrix to obtain a position error vector. A combining step, combining the angle error vector and the position error vector into the terminal position error corresponding to the target interpolation point; Repeat the determining step, the first calibration step, the controlling step, the second calibration step, the calculating step and the combining step at least once in sequence until the terminal pose errors corresponding to all the interpolation points are obtained.

4. The method according to claim 3, characterized in that Calculating the angular velocity error of each interpolation point according to each terminal posture error includes: Determine a relative Jacobian matrix corresponding to the interpolation point according to the theoretical rotation matrix and the theoretical displacement matrix of the interpolation point; An inverse kinematics formula is established according to the relative Jacobian matrix, wherein the dependent variable of the inverse kinematics formula is the angular acceleration vector, and the independent variable of the inverse kinematics formula is the terminal posture vector of the target robot, wherein the terminal posture vector includes the moving speed along each coordinate axis of the terminal coordinate system and the rotation speed around each coordinate axis of the terminal coordinate system; Substituting each of the terminal posture errors into the inverse kinematics formula, the angular velocity error of each of the interpolation points is obtained.

5. The method according to claim 1, characterized in that Compensating the joint angle of the corresponding interpolation point according to each angular velocity error to obtain the actual interpolation joint angle of each interpolation point includes: Calculate the product of the angular velocity error and the corresponding movement time of each interpolation point to obtain the compensated joint angle of each interpolation point, wherein the movement time is the time length from the starting point of the wrist singular area to the interpolation point; The sum of the joint angle of each interpolation point and the corresponding compensation joint angle is calculated to obtain the actual interpolation joint angle of each interpolation point.

6. The method according to claim 2, characterized in that Before controlling the target robot to pass through the wrist singularity region according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each interpolation point, the method further includes: Update the joint angle calculation formula according to the actual interpolated joint angle of each interpolation point to obtain an updated joint angle calculation formula; Derivative the updated joint angle calculation formula is taken to calculate the joint angular velocity corresponding to the actual interpolation joint angle of each interpolation point; The updated joint angle calculation formula is secondarily derived to calculate the joint angle acceleration corresponding to the actual interpolation joint angle of each interpolation point.

7. A wrist-surprising crossing device, characterized in that: include: A planning unit, used for performing trajectory planning on the wrist singular region of the target robot to obtain a plurality of interpolation points, wherein the interpolation point is any point in the wrist singular region; A first calculation unit, used for calculating the terminal posture error corresponding to each interpolation point in the wrist singular area, wherein the terminal posture error includes a position error and a rotation angle error; A second calculation unit is used to calculate the angular velocity error of each interpolation point according to each terminal posture error, wherein the angular velocity error is the error between the theoretical angular velocity and the actual angular velocity of the interpolation point; A compensation unit, used for compensating the joint angle of the corresponding interpolation point according to each angular velocity error to obtain an actual interpolation joint angle of each interpolation point; A control unit is used to control the target robot to pass through the wrist singular area according to the actual interpolation joint angle, the corresponding joint angular velocity and the corresponding joint angular acceleration of each interpolation point.

8. A computer-readable storage medium, characterized in that: The computer-readable storage medium includes a stored program, wherein when the program is executed, the device where the computer-readable storage medium is located is controlled to execute the method according to any one of claims 1 to 6.

9. A computer program product, comprising a computer program, characterized in that When the computer program is executed by a processor, the method according to any one of claims 1 to 6 is implemented.

10. A robot system, characterized in that: include: At least one robot, one or more processors, a memory, and one or more programs, wherein the one or more programs are stored in the memory and are configured to be executed by the one or more processors, and the one or more programs include instructions for executing the method described in any one of claims 1 to 6.

Citation Information

Patent Citations

  • Method of six-DOF industrial robot passing singular region

    CN103909522A

  • Error modeling method for tail-end space curve track of six-degree-of-freedom robot

    CN107053176A

  • Robot positioning error graded compensation method

    CN108908327A

  • Singularity treatment method for six-degree-of-freedom articulated robot

    CN110802600A

  • Singular position avoidance method, system and device, and computer readable storage medium

    CN112405525A

Cited By

  • Robot control method and control device

    CN119260749A

  • Mechanical arm singular point avoiding method, system and equipment and storage medium

    CN121157016A