Transition method and device for Cartesian track and joint track of robot
By determining the starting point and end point of the transition trajectory and using three non-uniform B-spline interpolation, the problem of velocity and acceleration discontinuity in the transition of the robot Cartesian trajectory and joint trajectory is solved, and the smooth transition of the trajectory and the working efficiency are achieved. promote.
Patent Information
- Application Number
- CN202410851243.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-06-27
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2044-06-27
AI Technical Summary
The existing Cartesian trajectory and joint trajectory transition methods of robots cannot ensure the continuous velocity and acceleration of the trajectory, resulting in the robot's torsional swing and overshoot in the transition range and low motion efficiency.
By obtaining the joint angle vector corresponding to the starting point and end point of the initial Cartesian trajectory, determine the starting point and end point of the transition trajectory, and determine multiple control vertices therein, use three non-uniform B-spline interpolation to obtain the transition trajectory, ensuring the trajectory's Speed and acceleration are continuous.
The smooth transition of the Cartesian trajectory and joint trajectory of the robot is realized, avoiding twisting and overshooting, and improving the robot's operating efficiency.
Smart Images

Figure CN118906044A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robot trajectory planning, and in particular to a method and device for transitioning between a robot's Cartesian trajectory and a joint trajectory. Background Art
[0002] The motion trajectory of a robot can be divided into Cartesian trajectory and joint trajectory. When performing some tasks, the robot needs to execute Cartesian space motion instructions and joint space motion instructions multiple times, which will cause the robot to start and stop multiple times to complete the corresponding motion instructions, greatly reducing the robot's motion efficiency. Therefore, designing a transition algorithm between Cartesian trajectory and joint trajectory can not only greatly improve the robot's operating efficiency, but also enable the robot to execute different spatial motion instructions more flexibly. At present, there have been studies on transition methods between Cartesian trajectory and joint trajectory; among them, the design goal of one transition method is to ensure that the velocity and acceleration of the Cartesian space trajectory and the joint space trajectory after the transition are continuous, but the transition trajectory of this method is completed in the joint space, and the shape of the robot's Cartesian space trajectory cannot be guaranteed. When the transition trajectory interval is too large, the robot's Cartesian trajectory in the transition interval is prone to torsion, overshoot and other problems; another transition method performs an inverse operation on the planned Cartesian trajectory to obtain the corresponding joint information, takes the end point of the Cartesian trajectory as the starting point of the joint trajectory, and completes the corresponding trajectory planning in the joint space, but when the speed at the end of the Cartesian trajectory is 0, the robot will still start and stop, and the motion efficiency is low. Summary of the invention
[0003] The present application provides a method and device for transitioning between the Cartesian trajectory and the joint trajectory of a robot, which can achieve a smooth transition between the Cartesian trajectory and the joint trajectory of the robot, ensure the continuity of the velocity and acceleration of the trajectory while avoiding torsion and overshoot.
[0004] On the one hand, an embodiment of the present application provides a method for transitioning between a Cartesian trajectory and a joint trajectory of a robot, wherein the Cartesian trajectory is a motion trajectory of a robot end in a Cartesian space, and the joint trajectory is a motion trajectory of a robot joint in a joint space, comprising the following steps:
[0005] Get the starting point Q of the initial Cartesian trajectory s and the end point Q m The corresponding joint angle vectors θ1 and θ2, and the end point Q of the initial joint trajectory e The corresponding joint angle vector θ3 determines the starting point Q1 and the end point Q2 of the transition trajectory based on θ1, θ2 and θ3;
[0006] Determine a plurality of control vertices between Q1 and Q2, and perform cubic non-uniform B-spline curve interpolation based on Q1 and Q2 and the plurality of control vertices to obtain the transition trajectory Q1Q2;
[0007] In Q s Plan the updated Cartesian trajectory between Q2 and Q1; e Plan the updated joint trajectory between them;
[0008] The updated Cartesian trajectory, the transition trajectory Q1Q2 and the updated joint trajectory are sequentially spliced to obtain the optimized trajectory Q s Q e .
[0009] On the other hand, an embodiment of the present application further provides a transition device between a Cartesian trajectory and a joint trajectory of a robot, comprising a processor and a memory;
[0010] The memory is used to store the transition program between the Cartesian trajectory and the joint trajectory of the robot;
[0011] The processor is used to read the transition program between the Cartesian trajectory and the joint trajectory of the robot, and perform the transition method between the Cartesian trajectory and the joint trajectory of the robot as described in the above embodiment.
[0012] Compared with the related art, a method and device for transitioning the Cartesian trajectory and the joint trajectory of a robot in an embodiment of the present application obtains a transition trajectory between the Cartesian space and the joint space in the Cartesian space, which can achieve a smooth transition between the Cartesian trajectory and the joint trajectory of the robot, ensure the continuity of the velocity and acceleration of the trajectory while avoiding torsion and overshoot at the end of the robot, avoid the start and stop of the robot in the two trajectories, and improve the robot's operating efficiency.
[0013] Other features and advantages of the present application will be described in the following description, and partly become apparent from the description, or be understood by implementing the present application. Other advantages of the present application can be realized and obtained by the schemes described in the description and the drawings. BRIEF DESCRIPTION OF THE DRAWINGS
[0014] The accompanying drawings are used to provide an understanding of the technical solution of the present application and constitute a part of the specification. Together with the embodiments of the present application, they are used to explain the technical solution of the present application and do not constitute a limitation on the technical solution of the present application.
[0015] Figure 1 is a flow chart of a method for transitioning between a Cartesian trajectory and a joint trajectory of a robot according to an embodiment of the present application;
[0016] Figure 2 is the optimized trajectory Q of the embodiment of the present application s Q e Distribution diagram of each point in the
[0017] Figure 3It is a rendering of the transition trajectory Q1Q2 of a specific example of this application;
[0018] Figure 4 It is an enlarged view of the effect diagram of the transition trajectory Q1Q2 of the specific example of this application;
[0019] Figure 5 It is a graph showing the angular velocity variation trend of joint 3 in the transition trajectory Q1Q2 in a specific example of the present application;
[0020] Figure 6 is a changing trend diagram of the angular acceleration of the joint 3 in the transition trajectory Q1Q2 of the specific example of the present application;
[0021] Figure 7 It is a schematic diagram of a transition device between a Cartesian trajectory and a joint trajectory of a robot according to an embodiment of the present application. DETAILED DESCRIPTION
[0022] The present application describes multiple embodiments, but the description is exemplary rather than restrictive, and it is obvious to those skilled in the art that there may be more embodiments and implementations within the scope of the embodiments described in the present application. Although many possible feature combinations are shown in the drawings and discussed in the specific embodiments, many other combinations of the disclosed features are also possible. Unless specifically limited, any feature or element of any embodiment may be used in combination with any other feature or element in any other embodiment, or may replace any other feature or element in any other embodiment.
[0023] The present application includes and contemplates combinations of features and elements known to those of ordinary skill in the art. The embodiments, features and elements disclosed in the present application may also be combined with any conventional features or elements to form a unique invention scheme defined by the claims. Any features or elements of any embodiment may also be combined with features or elements from other invention schemes to form another unique invention scheme defined by the claims. Therefore, it should be understood that any feature shown and / or discussed in the present application may be implemented individually or in any appropriate combination. Therefore, except for the limitations made according to the attached claims and their equivalents, the embodiments are not subject to other restrictions. In addition, various modifications and changes may be made within the scope of protection of the attached claims.
[0024] In addition, when describing representative embodiments, the specification may have presented the method and / or process as a specific sequence of steps. However, to the extent that the method or process does not rely on the specific order of the steps described herein, the method or process should not be limited to the steps of the specific order described. As will be understood by those of ordinary skill in the art, other sequences of steps are also possible. Therefore, the specific sequence of the steps set forth in the specification should not be interpreted as a limitation to the claims. In addition, the claims for the method and / or process should not be limited to the steps of performing them in the order written, and those skilled in the art can easily understand that these sequences can be changed and still remain within the spirit and scope of the embodiments of the present application.
[0025] The embodiment of the present application provides a method for transitioning between a Cartesian trajectory and a joint trajectory of a robot, wherein the Cartesian trajectory is a motion trajectory of a robot end in a Cartesian space, and the joint trajectory is a motion trajectory of a robot joint in a joint space, including steps S100-S400, such as Figure 1 As shown,
[0026] S100: Get the starting point Q of the initial Cartesian trajectory s and the end point Q m The corresponding joint angle vectors θ1 and θ2, and the end point Q of the initial joint trajectory e The corresponding joint angle vector θ3 determines the starting point Q1 and the end point Q2 of the transition trajectory based on θ1, θ2 and θ3;
[0027] S200: determining a plurality of control vertices between Q1 and Q2, and performing cubic non-uniform B-spline curve interpolation based on Q1 and Q2 and the plurality of control vertices to obtain the transition trajectory Q1Q2;
[0028] S300: In Q s Plan the updated Cartesian trajectory between Q2 and Q1; e Plan the updated joint trajectory between them;
[0029] S400: sequentially concatenate the updated Cartesian trajectory, the transition trajectory Q1Q2 and the updated joint trajectory to obtain an optimized trajectory Q s Q e .
[0030] In this embodiment, the robot end can be any one of a clamp, a suction device, a welding gun, a bionic hand, and a gripper. The above robot end examples are all illustrative descriptions and are not limitations of this application, and will not be described one by one in this article.
[0031] In this embodiment, the number of robot joints can be any, depending on the type of robot and the application scenario. The robot can be a serial robot with six or fewer rotational joints, a SCARA robot with three to four joints, a Delta robot with three parallel joint arms, a spherical robot with at least two rotational joints, a humanoid robot with dozens of joints, etc. The above robot examples are all illustrative descriptions and are not limitations of the present application, and will not be described in detail herein.
[0032] In this embodiment, the transition trajectory Q1Q2 is obtained by using cubic non-uniform B-spline curve interpolation, which can ensure the continuity of the robot's speed and acceleration in the transition trajectory and ensure the smooth transition of the Cartesian trajectory and the joint trajectory.
[0033] The method for transitioning the Cartesian trajectory and the joint trajectory of the robot in this embodiment uses the optimized trajectory to replace the original Cartesian trajectory and joint trajectory, and obtains the transition trajectory between the Cartesian space and the joint space in the Cartesian space. This can achieve a smooth transition between the Cartesian trajectory and the joint trajectory of the robot, ensure the continuity of the velocity and acceleration of the trajectory, and avoid torsion and overshoot at the end of the robot, avoid the start and stop of the robot in the two trajectories, and improve the robot's operating efficiency.
[0034] In an exemplary embodiment, step S100 may include steps S110-S140:
[0035] S110: Get Q s The corresponding joint angle vector θ1, and based on the position forward solution model P = H(θ), the end pose vector P1 corresponding to θ1 is obtained;
[0036] S120: Get Q m The corresponding joint angle vector θ2 is obtained, and based on the position forward solution model P=H(θ), the end position vector P2 corresponding to θ2 is obtained;
[0037] S130: In the Cartesian space, according to the Cartesian trajectory motion time percentage σ1, based on P1 and P2 in Q s and Q m Determine the starting point Q1 of the transition trajectory;
[0038] S140: Get Q e The corresponding joint angle vector θ3, in the joint space, is calculated based on θ2 and θ3 in Q according to the joint trajectory motion time percentage σ2. m and Q e Determine the end point Q2 of the transition trajectory;
[0039] In this embodiment, H(θ) is the transformation function of the robot joint angle vector θ to the robot end posture vector P, where P includes the end position coordinates and the end posture coordinates, 0<σ1<1, 0<σ2<1, σ1 and σ2 are preset values determined according to the robot transition accuracy requirements.
[0040] In other embodiments, other methods may be used to s and Q m Determine the starting point Q1 of the transition trajectory, for example, according to Q s and Q m The length of the initial Cartesian trajectory and a preset first length ratio are determined, and a position point on the initial Cartesian trajectory corresponding to the first length ratio is selected as Q1.
[0041] In other embodiments, other methods may be used to m and Q e Determine the end point Q2 of the transition trajectory, for example, according to Q m and Q e The length of the initial joint trajectory and the preset second length ratio are calculated, and the position point on the initial joint trajectory corresponding to the second length ratio is selected as Q2.
[0042] In an exemplary embodiment, step S130 may include steps S131-S133:
[0043] S131: In the Cartesian space, the terminal posture coordinates in P1 and P2 are respectively converted into posture quaternions R Φ1 and R Φ2;
[0044] S132: Using the end position coordinates in P1 and R Φ1 as Q s The endpoint data is the end position coordinates in P2 and R Φ2 as Q m The endpoint data of Q s and Q m Perform position and attitude planning between them to obtain the first initial trajectory Q s Q m , and obtain the first initial trajectory Q s Q m Movement time t;
[0045] S133: Calculate the time t′=σ1t according to the Cartesian trajectory motion time percentage σ1, and place the time t′ on the first initial trajectory Q s Q m The corresponding trajectory point in is used as the starting point Q1 of the transition trajectory.
[0046] In an exemplary embodiment, step S140 may include steps S141-S145:
[0047] S141: Perform the following operations on each joint in the joint space: Take θ2 as Q m End point data, with θ3 as Q e The endpoint data in Q m and Q e Perform five-order polynomial planning between to obtain the single joint initial trajectory and the single joint trajectory running time t i ′, where i = 1, 2, ... N, N is the total number of joints;
[0048] S142: In all t i Take the maximum value t j ′=max{t i ′}, where j represents the jth joint among N joints;
[0049] S143: With t j ′ is the time scale, and the following operations are performed on the other N-1 joints except the jth joint: the time synchronization processing is performed on the initial trajectory of the single joint, so that the running time of the single joint trajectory is t i ′ is equal to t j ′, obtain the single joint trajectory after time synchronization;
[0050] S144: Take the N-1 time-synchronized single joint trajectories and the single joint initial trajectory of the j-th joint as the second initial trajectory Q m Q e ;
[0051] S145: Calculate the time t1′=(1-σ2)t according to the joint trajectory motion time percentage σ2 j ', the time t1' is in the second initial trajectory Q m Q e The corresponding trajectory point in is used as the end point Q2 of the transition trajectory.
[0052] In an exemplary embodiment, after step S100 and before step S200, steps S150-S180 may be included:
[0053] S150: According to the first initial trajectory Q s Q m Get the terminal pose coordinates P corresponding to Q1 in the Cartesian space Q1 and the terminal velocity vector V Q1 c , where P Q1 Including end position coordinates Q1c and the terminal posture coordinates P′ Q1 ; The terminal posture coordinate P′ Q1 Convert to attitude quaternion R Φ Q1 ;
[0054] S160: According to the second initial trajectory Q m Q e Get the joint angle vector θ corresponding to Q2 Q2 and the joint angular velocity vector
[0055] S170: θ Q2 Input the position solution model P = H (θ) to obtain the terminal position coordinate P corresponding to Q2 in the Cartesian space Q2 , where P Q2 Including the end position coordinates Q2 c and the terminal posture coordinates P′ Q2 ; The terminal posture coordinate P′ Q2 Convert to attitude quaternion R Φ Q2 ;
[0056] S180: Input velocity forward kinematics model Get the terminal velocity vector V Q2 c , where J is the robot Jacobian matrix.
[0057] In this embodiment, the parameters of the robot end corresponding to the starting point Q1 and the end point Q2 of the transition trajectory can be obtained through steps S150-S180: the terminal velocity vector, the terminal position coordinates and the attitude quaternion. Based on these parameters of the robot end, multiple control vertices between Q1 and Q2 can be determined. This embodiment is a preferred implementation scheme of the present application and is not intended to be a limitation of the present application.
[0058] In an exemplary embodiment, determining a plurality of control vertices between Q1 and Q2 in step S200 may include steps S211-S216:
[0059] S211: Based on Q1 c The first straight line distance l is determined by the end position coordinates in P2 p1 ; Based on Q2 c The second straight line distance l is determined by the end position coordinates in P2 p2 ;
[0060] S212: Q1 c 、V Q1 c and lp1 Substitute into the formula Obtaining the position coordinates of the second control vertex d2 in the Cartesian space;
[0061] S213: Q1 c 、V Q1 c and l p1 Substitute into the formula Obtaining the position coordinates of the third control vertex d3 in the Cartesian space;
[0062] S214: Q2 c 、V Q2 c and l p2 Substitute into the formula Obtaining the position coordinates of the fifth control vertex d5 in the Cartesian space;
[0063] S215: Q2 c 、V Q2 c and l p2 Substitute into the formula Obtaining the position coordinates of the sixth control vertex d6 in the Cartesian space;
[0064] S216: By formula Obtaining the position coordinates of the fourth control vertex d4 in the Cartesian space;
[0065] In this embodiment, E=[I 3×3 O 3×3 ], I 3×3 is a 3-row 3-column identity matrix, O 3×3 is a 3-row, 3-column zero matrix, ||EV Q1 c ||2 is the matrix EV Q1 c The 2-norm of ||EV Q2 c ||2 is the matrix EV Q2 c The 2-norm of .
[0066] In this embodiment, the method for determining control vertices d2, d3, d4, d5, and d6 between Q1 and Q2 is to determine the position coordinates of these control points in Cartesian space. This method is suitable for determining control vertices of cubic non-uniform B-spline curves. It not only solves the problem that it is difficult to select control points for cubic non-uniform B-spline curves in joint space, but also effectively realizes the speed continuity between the transition trajectory and the joint trajectory, thereby improving the smoothness of the transition trajectory.
[0067] In this embodiment, the method of determining control vertices d2, d3, d4, d5, and d6 between Q1 and Q2 is not only applicable to straight Cartesian trajectories, but also when the initial Cartesian trajectory is a circular arc trajectory, it can also achieve a good transition between the Cartesian trajectory and the transition trajectory, and can ensure the continuity of speed changes, a smaller degree of acceleration change, and a smoother transition trajectory. Since the initial joint trajectory appears as an irregular curve in Cartesian space, the method of determining control vertices in this embodiment is proposed.
[0068] In an exemplary embodiment, the step S200 of performing cubic non-uniform B-spline curve interpolation based on Q1 and Q2 and the plurality of control vertices to obtain the transition trajectory Q1Q2 may include steps S221-S226:
[0069] S221: According to V Q1 c Calculate the total velocity of the starting point Q1 of the transition trajectory || v Q1 c ||2, according to V Q2 c Calculate the total velocity of the end point Q2 of the transition trajectory || v Q2 c ||2;
[0070] S222: Will ||v Q1 c ||2 and ||v Q2 c || 2 are respectively used as the initial speed and the final speed of the transition trajectory, and S speed planning is performed to obtain the feed speed V(u) of the transition trajectory;
[0071] S223: Using the second-order Taylor expansion method, according to V(u) and the interpolation period T s Calculate the node increment u of a cubic non-uniform B-spline curve λ+1 ;
[0072] S224: According to Q1 c 、Q2 c 、u λ+1 and the plurality of control vertices, calculating the position coordinates of all trajectory points of the transition trajectory by the De Boor recursive formula;
[0073] S225: Using slerp interpolation method in attitude quaternion R Φ Q1 and R Φ Q2 Interpolate between them to obtain the attitude quaternion of all trajectory points of the transition trajectory;
[0074] S226: Synchronize the position coordinates of all the trajectory points with the attitude quaternions of all the trajectory points to obtain the transition trajectory Q1Q2.
[0075] In this embodiment, the multiple control vertices can be d2, d3, d4, d5, and d6. These five control vertices together with Q1 and Q2 form seven control vertices of the cubic non-uniform B-spline curve. The order of these seven control vertices is Q1, d2, d3, d4, d5, d6, and Q2, which are used to determine the shape of the cubic non-uniform B-spline curve.
[0076] In this embodiment, in step S223, the node increment u of the cubic non-uniform B-spline curve is calculated. λ+1 The formula is formula (1):
[0077]
[0078] In formula (1), C(u λ ) represents the De Boor recursive formula of the cubic non-uniform B-spline curve, C′(u λ ) and C″(u λ ) represent the cubic non-uniform B-spline curve with parameter u λ The first and second order derivatives at , where C(u λ ) is calculated as formula (2):
[0079]
[0080] In formula (2), k is the degree of the cubic non-uniform B-spline curve, k=3; n is the number of control vertices, n=7;
[0081]
[0082] Regulation
[0083] In an exemplary embodiment, the step S300 is performed in Q s Planning the updated Cartesian trajectory between Q1 and Q2 may include step S310:
[0084] S310: In the Cartesian space, Q s and the posture speed of Q1 are set to 0, combined with the end position coordinates of Q1 c , the terminal velocity vector V Q1 c and the attitude quaternion R Φ Q1 , for the first initial trajectory Q s Q m Qs and Q1 to obtain the updated Cartesian trajectory Q s Q1.
[0085] In an exemplary embodiment, the step S300 is performed between Q2 and Q e Planning the updated joint trajectory may include step S320:
[0086] S320: In the joint space, Q2 and Q e The accelerations are set to 0, and the joint angle vector θ of Q2 is combined Q2 , the joint angular velocity vector For the second initial trajectory Q m Q e Q2 and Q e Perform quintic polynomial replanning between them to obtain the updated joint trajectory Q2Q e .
[0087] In an exemplary embodiment, after step S320, steps S330-S340 may be further included:
[0088] S330: Set the time proportional coefficient σ3 and calculate the time t2′=(1-σ3)t j ′, t2′ is the updated joint trajectory Q2Q e The corresponding trajectory point in is taken as Q3, where 0<σ3<σ2<1;
[0089] S340: After the update, the joint trajectory Q2Q e The quintic polynomial planning is re-performed between Q2 and Q3 to obtain the smooth trajectory Q2Q3.
[0090] In this embodiment, the smooth trajectory Q2Q3 can be obtained through steps S330-S340 to achieve the purpose of global trajectory acceleration continuity. Obtaining the smooth trajectory Q2Q3 is a preferred implementation of the embodiment of the present application and is not a limitation of the present application. Even if the smooth trajectory Q2Q3 is not obtained, it is still possible to obtain the smooth trajectory Q2Q3 according to the updated Cartesian trajectory Q s Q1, transition trajectory Q1Q2 and updated joint trajectory Q2Q e Get the optimized trajectory Q s Q e .
[0091] In an exemplary embodiment, step S340 may include steps S341-S342:
[0092] S341: According to the updated joint trajectory Q2Q e Determine the joint angle vector θ corresponding to Q3 Q3、Joint angular velocity vector and the joint acceleration vector
[0093] S342: In the joint space, take t2′-t1′ as the smoothing time of velocity and acceleration, combined with θ Q3 , and Re-perform quintic polynomial planning between Q2 and Q3 to obtain the smooth trajectory Q2Q3.
[0094] In an exemplary embodiment, step S400 may include step S410:
[0095] S410: Update the Cartesian trajectory Q s Q1, the transition trajectory Q1Q2, the smooth trajectory Q2Q3 and the updated joint trajectory Q2Q e Q3 to Q e The segments are sequentially spliced to obtain the optimized trajectory Q s Q e .
[0096] In this embodiment, the optimized trajectory Q s Q e The distribution of each point in is as follows Figure 2 As shown, where Q s is the starting point of the optimized trajectory, corresponding to the end pose vector P1 in Cartesian space and the joint angle vector θ1 in joint space; Q e is the end point of the optimized trajectory, corresponding to the joint angle vector θ3 in the joint space; Q1 is the starting point of the transition trajectory; Q2 is the end point of the transition trajectory, which is also the starting point of the smooth trajectory; Q3 is the end point of the smooth trajectory; Q m Corresponding to the end pose vector P2 in Cartesian space and the joint angle vector θ2 in joint space.
[0097] In an exemplary embodiment, before step S100, steps S010-S020 may be included:
[0098] S010: construct the robot's position forward solution model P = H(θ) and position inverse solution model θ = G(P);
[0099] S020: Constructing the velocity forward kinematics model of the robot based on the position inverse solution model θ=G(P) and
[0100] Velocity Inverse Kinematics Model
[0101] In this embodiment, H(θ) is the transformation function of the robot joint angle vector θ to the robot end posture vector P, and G(P) is the transformation function of the robot end posture vector P to the robot joint angle vector θ; θ = [θ1, θ2, ..., θ N ] T , N is the total number of joints, θ i is the joint angle vector of the i-th joint in the joint space, i∈[1,N]; P is the terminal pose vector of the robot terminal in the Cartesian space, P=[x p y p z p ψ px ψ py ψ pz ] T , x p ,y p , z p is the end position coordinate, ψ px , ψ py , ψ pz is the terminal posture coordinate.
[0102] In this embodiment, J is the Jacobian matrix of the robot, J -1 is the inverse matrix of J; is the joint angular velocity vector of the ith joint in the joint space; V is the terminal velocity vector of the robot terminal in the Cartesian space, V = [v x v y v z ω x ω y ω z ] T ,v x , v y and v z are the velocity components of the robot end in the x, y and z directions in the Cartesian space, ω x ,ω y and ω z are the rotational angular velocity components of the robot end around the x, y and z axes of the Cartesian coordinate system in the Cartesian space, respectively.
[0103] In this embodiment, four models of the robot can be constructed through steps S010-S020: the position forward solution model P = H (θ), the position inverse solution model θ = G (P), and the velocity forward kinematics model and velocity inverse kinematics model Whenever the transition between Cartesian trajectory and joint trajectory needs to be realized, the four constructed models can be used.
[0104] In order to illustrate the transition method between the Cartesian trajectory and the joint trajectory of the robot in the embodiment of the present application, a specific example is used to describe it in detail below, including steps S1-S26. In this specific example, the number of joints N=6.
[0105] S1: Construct the robot's position forward solution model P = H(θ) and position inverse solution model θ = G(P);
[0106] Specifically, according to the DH parameters of the robot, the coordinate transformation matrices of the machine joint i and joint i-1 are calculated respectively: i- 1 T i , (i=1,2,3,…,6), i-1 T i The expression is:
[0107]
[0108] in accordance with i-1 T i The expression calculates the transformation matrix of the i-th joint to the joint coordinate system 0 T i :
[0109]
[0110] in accordance with 0 T i The forward solution model of the position P=H(θ) is obtained, and the inverse solution model of the robot position θ=G(P) is obtained by the inversion method.
[0111] S2: Construct the robot's velocity forward kinematics model based on the position inverse solution model θ=G(P) and
[0112] Velocity Inverse Kinematics Model
[0113] Specifically, according to S1 0 T i , define z i =[ i a x i a y i a z ] T , 0 q i =[ i q x i q y i q z ] T , The Jacobian matrix J is calculated by the following formula:
[0114]
[0115] According to the Jacobian matrix J, the velocity forward kinematics model can be obtained and
[0116] Velocity Inverse Kinematics Model
[0117] S3: Get the starting point Q of the initial Cartesian trajectory s and the end point Q m The corresponding joint angle vectors θ1 and θ2 are obtained respectively, and the terminal pose vectors P1 and P2 corresponding to θ1 and θ2 are obtained based on the position forward solution model P = H(θ);
[0118] Specifically, θ1=[-10-100 36-23 -20], θ2=[3020-15 -60-45 20], the six numbers in θ1 and θ2 represent the joint angles of the six joints respectively, the unit of θ1 and θ2 is Deg, θ1 and θ2 are respectively input into the position correct solution model P=H(θ) to obtain P1 and P2.
[0119] S4: In the Cartesian space, the terminal posture coordinates in P1 and P2 are converted into posture quaternions respectively. R Φ1 and R Φ2, using seven-segment S speed planning and slerp interpolation method in Q s and Q m The position and attitude are planned between them, and the planned position and attitude are synchronized to obtain the first initial trajectory Q s Q m , and obtain the first initial trajectory Q s Q m Movement time t;
[0120] S5: Calculate the time t′=σ1t according to the Cartesian trajectory motion time percentage σ1, and place the time t′ on the first initial trajectory Q s Q m The corresponding trajectory point in is taken as the starting point Q1 of the transition trajectory;
[0121] S6: According to the first initial trajectory Q s Q m Get the terminal pose coordinates P corresponding to Q1 in the Cartesian space Q1 and the terminal velocity vector V Q1 c , where P Q1 Including end position coordinates Q1 cand the terminal posture coordinates P′ Q1 ; The terminal posture coordinate P′ Q1 Convert to attitude quaternion R Φ Q1 ;
[0122] Specifically, the first initial trajectory Q obtained in this specific example is s Q m The movement time t = 1.644s, the Cartesian trajectory movement time percentage σ1 = 0.8, the end position coordinate Q1 c =[0.98990.60620.5866], terminal velocity vector V Q1 c =[-0.0562 0.36-10], attitude quaternion R Φ Q1 =[0.5101-0.83950.1375-0.1271].
[0123] S7: Get the end point Q of the initial joint trajectory e The corresponding joint angle vector θ3, in the joint space, performs the following operations on each joint: Taking θ2 as Q m End point data, with θ3 as Q e The endpoint data in Q m and Q e Perform five-order polynomial planning between to obtain the single joint initial trajectory and the single joint trajectory running time t i ′, where i = 1, 2, ... 6;
[0124] S8: In all t i Take the maximum value t j ′=max{t i ′}, where j represents the jth joint among the 6 joints;
[0125] Specifically, θ3 = [71.453.3-21.143.2-37.864.8], where the six numbers in θ3 represent the joint angles of the six joints, in units of Deg; t j ′=2.0231s.
[0126] S9: With t j ′ is the time scale, and the following operations are performed on the other five joints except the jth joint: the time synchronization processing is performed on the initial trajectory of the single joint, so that the running time of the single joint trajectory is t i ′ is equal to t j ′, obtain the single joint trajectory after time synchronization;
[0127] S10: Take the five time-synchronized single joint trajectories and the single joint initial trajectory of the j-th joint as the second initial trajectory Q m Q e ;
[0128] S11: Calculate the time t1′=(1-σ2)t according to the joint trajectory motion time percentage σ2 j ', the time t1' is in the second initial trajectory Q m Q e The corresponding trajectory point in is taken as the end point Q2 of the transition trajectory;
[0129] S12: According to the second initial trajectory Q m Q e Get the joint angle vector θ corresponding to Q2 Q2 and the joint angular velocity vector
[0130] Specifically, θ Q2 =[0.5653 0.3826-0.26791.03030.70200.3942], the six numbers represent the joint angles of the six joints, in rad; The six numbers represent the joint angular velocities of the six joints, in rad / s.
[0131] S13: Set θ Q2 Input the position solution model P = H (θ) to obtain the terminal position coordinate P corresponding to Q2 in the Cartesian space Q2 , where P Q2 Including the end position coordinates Q2 c and the terminal posture coordinates P′ Q2 ; The terminal posture coordinate P′ Q2 Convert to attitude quaternion R Φ Q2 ;
[0132] S14: Input velocity forward kinematics model Get the terminal velocity vector V Q2 c ;
[0133] S15: determining five control vertices d2, d3, d4, d5, and d6 between Q1 and Q2, and obtaining position coordinates of the five control vertices in the Cartesian space respectively;
[0134] Specifically, d2 = [0.9823 0.6221 0.5817]; d3 = [0.9948 0.6378 0.5769]; d4 = [0.9957 0.6587 0.5688]; d5 = [0.9967 0.6796 0.5607]; d6 = [0.9952 0.6901 0.5527].
[0135] S16: According to V Q1 c Calculate the total velocity of the starting point Q1 of the transition trajectory || v Q1 c ||2, according to V Q2 c Calculate the total velocity of the end point Q2 of the transition trajectory || v Q2 c ||2;
[0136] Specifically, ||v Q1 c ||2=0.3819m / s;||v Q2 c ||2=0.3987m / s.
[0137] S17: ||v Q1 c ||2 and ||v Q2 c ||2 are used as the initial speed and final speed of the transition trajectory, and S speed planning is performed to obtain the feed speed V(u) of the transition trajectory; the second-order Taylor expansion method is used according to V(u) and the interpolation period T s Calculate the node increment u of a cubic non-uniform B-spline curve λ+1 ;
[0138] S18: According to Q1 c 、Q2 c 、u λ+1 and controlling vertices d2, d3, d4, d5, and d6, and calculating the position coordinates of all trajectory points of the transition trajectory by the De Boor recursive formula;
[0139] S19: Using slerp interpolation method in attitude quaternion R Φ Q1 and R Φ Q2 Interpolate between them to obtain the attitude quaternion of all trajectory points of the transition trajectory;
[0140] S20: Synchronize the position coordinates of all the trajectory points with the attitude quaternions of all the trajectory points to obtain the transition trajectory Q1Q2.
[0141] S21: In the Cartesian space, Q s and the posture speed of Q1 are set to 0, combined with the end position coordinates of Q1 c , the terminal velocity vector V Q1 c and the attitude quaternion R Φ Q1 , for the first initial trajectory Q s Q m Q s and Q1 to obtain the updated Cartesian trajectory Q s Q1;
[0142] S22: In the joint space, Q2 and Q e The accelerations are set to 0, and the joint angle vector θ of Q2 is combined Q2 , the joint angular velocity vector For the second initial trajectory Q m Q e Q2 and Q e Perform quintic polynomial replanning between them to obtain the updated joint trajectory Q2Q e ;
[0143] S23: Set the time proportional coefficient σ3 and calculate the time t2′=(1-σ3)t j ′, t2′ is the updated joint trajectory Q2Q e The corresponding trajectory point in is taken as Q3, where 0<σ3<σ2<1;
[0144] S24: Update the joint trajectory Q2Q according to the e Determine the joint angle vector θ corresponding to Q3 Q3 、Joint angular velocity vector and the joint acceleration vector
[0145] S25: In the joint space, t2′-t1′ is used as the smoothing time of velocity and acceleration, combined with θ Q3 , and Re-perform quintic polynomial planning between Q2 and Q3 to obtain the smooth trajectory Q2Q3.
[0146] S26: Update the Cartesian trajectory Q s Q1, the transition trajectory Q1Q2, the smooth trajectory Q2Q3 and the updated joint trajectory Q2Q e Q3 to Q e The segments are sequentially spliced to obtain the optimized trajectory Qs Q e .
[0147] The effect diagram of the transition trajectory Q1Q2 obtained in this specific example is as follows: Figure 3 and Figure 4 As shown, Figure 3 and Figure 4 The coordinate system in is the Cartesian coordinate system of the Cartesian space. The three axes of the Cartesian coordinate system are X, Y and Z, respectively, and the unit is meter (m). The solid line is the initial Cartesian trajectory, the dotted line is the initial joint trajectory, and the trajectory segment with a solid line and circle is the transition trajectory. Figure 4 for Figure 3 In the enlarged view of the transition trajectory Q1Q2, the initial trajectory includes the initial joint trajectory and the initial Cartesian trajectory. Figure 3 and Figure 4 It can be seen that the transition trajectory Q1Q2 obtained in this specific example achieves a smooth transition between the Cartesian trajectory and the joint trajectory.
[0148] The variation trend diagram of the angular velocity and angular acceleration of joint 3 in the transition trajectory Q1Q2 obtained in this specific example is as follows: Figure 5 and 6 As shown, the horizontal axis is time (s), and the vertical axis is angular velocity (rad / s) and angular acceleration (rad / s 2 ),Depend on Figure 5 and Figure 6 It can be seen that the angular velocity and angular acceleration of joint 3 in the transition trajectory Q1Q2 change continuously, ensuring the global continuity of velocity and acceleration.
[0149] The present application also provides a transition device between a robot Cartesian trajectory and a joint trajectory, such as Figure 7 As shown, it includes a processor and a memory;
[0150] The memory is used to store the transition program between the Cartesian trajectory and the joint trajectory of the robot;
[0151] The processor is used to read the transition program between the Cartesian trajectory and the joint trajectory of the robot, and perform the transition method between the Cartesian trajectory and the joint trajectory of the robot as described in the above embodiment.
[0152] It will be appreciated by those skilled in the art that all or some of the steps, systems, and functional modules / units in the methods disclosed above may be implemented as software, firmware, hardware, and appropriate combinations thereof. In hardware implementations, the division between the functional modules / units mentioned in the above description does not necessarily correspond to the division of physical components; for example, a physical component may have multiple functions, or a function or step may be performed by several physical components in cooperation. Some or all components may be implemented as software executed by a processor, such as a digital signal processor or a microprocessor, or implemented as hardware, or implemented as an integrated circuit, such as an application-specific integrated circuit. Such software may be distributed on a computer-readable medium, which may include a computer storage medium (or non-transitory medium) and a communication medium (or temporary medium). As known to those skilled in the art, the term computer storage medium includes volatile and non-volatile, removable and non-removable media implemented in any method or technology for storing information (such as computer-readable instructions, data structures, program modules, or other data). Computer storage media include, but are not limited to, RAM, ROM, EEPROM, flash memory or other memory technology, CD-ROM, digital versatile disks (DVD) or other optical disk storage, magnetic cassettes, magnetic tapes, magnetic disk storage or other magnetic storage devices, or any other medium that can be used to store the desired information and can be accessed by a computer. In addition, it is well known to those of ordinary skill in the art that communication media typically contain computer-readable instructions, data structures, program modules, or other data in a modulated data signal such as a carrier wave or other transport mechanism, and may include any information delivery media.
Claims
1. A method for transitioning between a robot Cartesian trajectory and a joint trajectory, wherein the Cartesian trajectory is the motion trajectory of the robot end in Cartesian space, and the joint trajectory is the motion trajectory of the robot joint in the joint space, characterized in that: The following steps are involved: Get the starting point Q of the initial Cartesian trajectory s and the end point Q m The corresponding joint angle vectors θ1 and θ2, and the end point Q of the initial joint trajectory e The corresponding joint angle vector θ3 determines the starting point Q1 and the end point Q2 of the transition trajectory based on θ1, θ2 and θ3; Determine a plurality of control vertices between Q1 and Q2, and perform cubic non-uniform B-spline curve interpolation based on Q1 and Q2 and the plurality of control vertices to obtain the transition trajectory Q1Q2; In Q s Plan the updated Cartesian trajectory between Q2 and Q1; e Plan the updated joint trajectory between them; The updated Cartesian trajectory, the transition trajectory Q1Q2 and the updated joint trajectory are sequentially spliced to obtain the optimized trajectory Q s Q e .
2. The method for transitioning between a robot Cartesian trajectory and a joint trajectory as claimed in claim 1, characterized in that: The starting point Q of the initial Cartesian trajectory is obtained s and the end point Q m The corresponding joint angle vectors θ1 and θ2, and the end point Q of the initial joint trajectory e The corresponding joint angle vector θ3 determines the starting point Q1 and the end point Q2 of the transition trajectory based on θ1, θ2 and θ3, including: Get Q s The corresponding joint angle vector θ1, and based on the position forward solution model P = H(θ), the end pose vector P1 corresponding to θ1 is obtained; Get Q m The corresponding joint angle vector θ2 is obtained, and based on the position forward solution model P=H(θ), the end position vector P2 corresponding to θ2 is obtained; In the Cartesian space, the Cartesian trajectory motion time percentage σ1, based on P1 and P2 in Q s and Q m Determine the starting point Q1 of the transition trajectory; Get Q e The corresponding joint angle vector θ3, in the joint space, is calculated based on θ2 and θ3 in Q according to the joint trajectory motion time percentage σ2. m and Q e Determine the end point Q2 of the transition trajectory; Among them, H(θ) is the transformation function of the robot joint angle vector θ to the robot end posture vector P, P includes the end position coordinates and the end posture coordinates, 0<σ1<1, 0<σ2<1, σ1 and σ2 are preset values determined according to the robot transition accuracy requirements.
3. The method for transitioning between a robot Cartesian trajectory and a joint trajectory as claimed in claim 2, characterized in that: In the Cartesian space, according to the Cartesian trajectory motion time percentage σ1, based on P1 and P2 in Q s and Q m Determine the starting point Q1 of the transition trajectory, including: In the Cartesian space, the end attitude coordinates in P1 and P2 are converted into attitude quaternions respectively R Φ1 and R Φ2; The end position coordinates in P1 and R Φ1 as Q s The endpoint data is the end position coordinates in P2 and R Φ2 as Q m The endpoint data of Q s and Q m Perform position and attitude planning between them to obtain the first initial trajectory Q s Q m , and obtain the first initial trajectory Q s Q m Movement time t; According to the Cartesian trajectory motion time percentage σ1, the time t′=σ1t is calculated, and the time t′ is placed on the first initial trajectory Q s Q m The corresponding trajectory point in is used as the starting point Q1 of the transition trajectory.
4. The method for transitioning between a robot Cartesian trajectory and a joint trajectory as claimed in claim 2, characterized in that: In the joint space, according to the joint trajectory motion time percentage σ2, based on θ2 and θ3 in Q m and Q e Determine the end point Q2 of the transition trajectory, including: In the joint space, the following operations are performed for each joint: θ2 is Q m End point data, with θ3 as Q e The endpoint data in Q m and Q e Perform five-order polynomial planning between to obtain the single joint initial trajectory and the single joint trajectory running time t i ′, where i = 1, 2, ... N, N is the total number of joints; In all t i Take the maximum value t j ′=max{t i ′}, where j represents the jth joint among N joints; With t j ′ is the time scale, and the following operations are performed on the other N-1 joints except the jth joint: the time synchronization processing is performed on the initial trajectory of the single joint, so that the running time of the single joint trajectory is t i ′ is equal to t j ′, obtain the single joint trajectory after time synchronization; Take the N-1 time-synchronized single joint trajectories and the single joint initial trajectory of the j-th joint as the second initial trajectory Q m Q e ; Calculate the time t1′=(1-σ2)t according to the joint trajectory motion time percentage σ2 j ', the time t1' is in the second initial trajectory Q m Q e The corresponding trajectory point in is used as the end point Q2 of the transition trajectory.
5. The method for transitioning between a robot Cartesian trajectory and a joint trajectory as claimed in claim 3 or 4, characterized in that: After determining the starting point Q1 and the end point Q2 of the transition trajectory and before determining a plurality of control vertices between Q1 and Q2, the method includes: According to the first initial trajectory Q s Q m Get the terminal pose coordinates P corresponding to Q1 in the Cartesian space Q1 and the terminal velocity vector V Q1 c , where P Q1 Including end position coordinates Q1 c and the terminal posture coordinates P′ Q1 ; The terminal posture coordinate P′ Q1 Convert to attitude quaternion R Φ Q1 ; According to the second initial trajectory Q m Q e Get the joint angle vector θ corresponding to Q2 Q2 and the joint angular velocity vector θ Q2 Input the position solution model P = H (θ) to obtain the terminal position coordinate P corresponding to Q2 in the Cartesian space Q2 , where P Q2 Including the end position coordinates Q2 c and the terminal posture coordinates P′ Q2 ; The terminal posture coordinate P′ Q2 Convert to attitude quaternion R Φ Q2 ; Will Input velocity forward kinematics model Get the terminal velocity vector V Q2 c , where J is the robot Jacobian matrix.
6. The method for transitioning between a robot Cartesian trajectory and a joint trajectory as claimed in claim 5, characterized in that: The step of determining a plurality of control vertices between Q1 and Q2 includes: Based on Q1 c The first straight line distance l is determined by the end position coordinates in P2 p1 ; Based on Q2 c The second straight line distance l is determined by the end position coordinates in P2 p2 ; Q1 c 、V Q1 c and l p1 Substitute into the formula Obtaining the position coordinates of the second control vertex d2 in the Cartesian space; Q1 c 、V Q1 c and l p1 Substitute into the formula Obtaining the position coordinates of the third control vertex d3 in the Cartesian space; Q2 c 、V Q2 c and l p2 Substitute into the formula Obtaining the position coordinates of the fifth control vertex d5 in the Cartesian space; Q2 c 、V Q2 c and l p2 Substitute into the formula Obtaining the position coordinates of the sixth control vertex d6 in the Cartesian space; By formula Obtaining the position coordinates of the fourth control vertex d4 in the Cartesian space; Among them, E=[I 3×3 O 3×3 ], I 3×3 is a 3-row 3-column identity matrix, O 3×3 is a 3-row, 3-column zero matrix, ||EV Q1 c ||2 is the matrix EV Q1 c The 2-norm of ||EV Q2 c ||2 is the matrix EV Q2 c The 2-norm of .
7. The method for transitioning between a robot Cartesian trajectory and a joint trajectory as claimed in claim 5, characterized in that: The method of performing cubic non-uniform B-spline curve interpolation based on Q1 and Q2 and the plurality of control vertices to obtain the transition trajectory Q1Q2 includes: According to V Q1 c Calculate the total velocity of the starting point Q1 of the transition trajectory || v Q1 c ||2, according to V Q2 c Calculate the total velocity of the end point Q2 of the transition trajectory || v Q2 c ||2; v Q1 c ||2 and ||v Q2 c || 2 are respectively used as the initial speed and the final speed of the transition trajectory, and S speed planning is performed to obtain the feed speed V(u) of the transition trajectory; Using the second-order Taylor expansion method, according to V(u) and the interpolation period T s Calculate the node increment u of a cubic non-uniform B-spline curve λ+1 ; According to Q1 c 、Q2 c 、u λ+1 and the plurality of control vertices, calculating the position coordinates of all trajectory points of the transition trajectory by the De Boor recursive formula; Use slerp interpolation method in attitude quaternion R Φ Q1 and R Φ Q2 Interpolate between them to obtain the attitude quaternion of all trajectory points of the transition trajectory; The position coordinates of all the trajectory points and the attitude quaternions of all the trajectory points are synchronized to obtain the transition trajectory Q1Q2.
8. The method for transitioning between a robot Cartesian trajectory and a joint trajectory as claimed in claim 5, characterized in that: As stated in Q s Plan the updated Cartesian trajectory between Q1 and Q2, including: In the Cartesian space, Q s and the posture speed of Q1 are set to 0, combined with the end position coordinates of Q1 c , the terminal velocity vector V Q1 c and the attitude quaternion R Φ Q1 , for the first initial trajectory Q s Q m Q s and Q1 to obtain the updated Cartesian trajectory Q s Q1.
9. The method for transitioning between a robot Cartesian trajectory and a joint trajectory as claimed in claim 5, characterized in that: In Q2 and Q e Plan the updated joint trajectory, including: In the joint space, Q2 and Q e The accelerations are set to 0, and the joint angle vector θ of Q2 is combined Q2 , the joint angular velocity vector For the second initial trajectory Q m Q e Q2 and Q e Perform quintic polynomial replanning between them to obtain the updated joint trajectory Q2Q e .
10. The method for transitioning between a robot Cartesian trajectory and a joint trajectory as claimed in claim 9, characterized in that: After obtaining the updated joint trajectory Q2Q e After that, it also includes: Set the time proportional coefficient σ3 and calculate the time t2′=(1-σ3)t j ′, t2′ is the updated joint trajectory Q2Q e The corresponding trajectory point in is taken as Q3, where 0<σ3<σ2<1; After the update, the joint trajectory Q2Q e The quintic polynomial planning is re-performed between Q2 and Q3 to obtain the smooth trajectory Q2Q3.
11. The method for transitioning between a robot Cartesian trajectory and a joint trajectory as claimed in claim 10, characterized in that: The re-performing of quintic polynomial planning between Q2 and Q3 of the updated joint trajectory to obtain a smooth trajectory Q2Q3 includes: According to the updated joint trajectory Q2Q e Determine the joint angle vector θ corresponding to Q3 Q3 、Joint angular velocity vector and the joint acceleration vector In the joint space, t2′-t1′ is used as the smoothing time of velocity and acceleration, combined with θ Q3 , and Re-perform quintic polynomial planning between Q2 and Q3 to obtain the smooth trajectory Q2Q3.
12. The method for transitioning between a robot Cartesian trajectory and a joint trajectory as claimed in claim 11, characterized in that: The updated Cartesian trajectory, the transition trajectory Q1Q2 and the updated joint trajectory are sequentially spliced to obtain the optimized trajectory Q s Q e ,include: The updated Cartesian trajectory Q s Q1, the transition trajectory Q1Q2, the smooth trajectory Q2Q3 and the updated joint trajectory Q2Q e Q3 to Q e The segments are sequentially spliced to obtain the optimized trajectory Q s Q e .
13. The method for transitioning between a robot Cartesian trajectory and a joint trajectory as claimed in claim 1, characterized in that: In the above method, the starting point Q of the initial Cartesian trajectory is obtained. s and the end point Q m The corresponding joint angle vectors θ1 and θ2, and the end point Q of the initial joint trajectory e The corresponding joint angle vector θ3 includes: Construct the robot's position forward solution model P = H (θ) and position inverse solution model θ = G (P); where H (θ) is the transformation function from the robot's joint angle vector θ to the robot's terminal posture vector P, and G (P) is the transformation function from the robot's terminal posture vector P to the robot's joint angle vector θ; θ = [θ1, θ2, ..., θ N ] T , N is the total number of joints, θ i is the joint angle vector of the i-th joint in the joint space, i∈[1,N]; P is the terminal pose vector of the robot terminal in the Cartesian space, P=[x p y p z p ψ px ψ py ψ pz ] T , x p ,y p , z p is the end position coordinate, ψ px , ψ py , ψ pz is the terminal posture coordinate; Based on the position inverse solution model θ=G(P), the velocity forward kinematics model of the robot is constructed. and velocity inverse kinematics model Where J is the Jacobian matrix of the robot, J -1 is the inverse matrix of J; is the joint angular velocity vector of the ith joint in the joint space; V is the terminal velocity vector of the robot terminal in the Cartesian space, V = [v x v y v z ω x ω y ω z ] T ,v x , v y and v z are the velocity components of the robot end in the x, y and z directions in the Cartesian space, ω x ,ω y and ω z are the rotational angular velocity components of the robot end around the x, y and z axes of the Cartesian coordinate system in the Cartesian space, respectively.
14. A transition device between a Cartesian trajectory and a joint trajectory of a robot, comprising a processor and a memory, characterized in that: The memory is used to store the transition program between the Cartesian trajectory and the joint trajectory of the robot; The processor is used to read the transition program between the Cartesian trajectory and the joint trajectory of the robot, and perform the transition method between the Cartesian trajectory and the joint trajectory of the robot as described in any one of claims 1-13.
Citation Information
Patent Citations
Smooth transition method of multi-space trajectory planning of teaching robot, and devices
CN107571261A
Robot joint layer control method and system
CN111267098A
Hybrid space transition trajectory planning method and device
CN114603558A
Robot control system, robot, robot control method, and program
JP2014161918A
Cited By
Mechanical arm track optimization method and mechanical arm digital twin system
CN120269583A
A method for optimizing the trajectory of a robotic arm and a digital twin system of a robotic arm
CN120269583B
