A method and device for planning joint space trajectory of multi-axis equipment
By acquiring the coordinates and kinematic constraints of joint nodes in a multi-axis device, and performing two trajectory planning to ensure synchronization and continuity, the motion constraints and efficiency problems in the prior art are solved, and the operating performance and planning accuracy of the equipment are improved.
Patent Information
- Application Number
- CN202211035176.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-08-26
- Publication Date
- 2024-11-29
- Estimated Expiration
- 2042-08-26
AI Technical Summary
The prior art cannot meet the motion constraints and improve the performance of the equipment in the trajectory planning of multi-axis equipment, resulting in wasted motion time and reduced work efficiency.
By obtaining the joint node coordinates of the multi-axis device, performing the first trajectory planning according to the kinematic constraints, determining the synchronization time, and planning with synchronization time and coordinates in the second trajectory planning, ensuring that each axis is in the joint space. Continuous trajectory, improving the synchronous operation performance of the equipment.
The synchronous operation of each axis of a multi-axis equipment is achieved, which improves the overall operating performance, reduces vibration, and improves the accuracy and ageing of trajectory planning.
Smart Images

Figure CN115179299B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field related to motion control, and in particular to a method and device for planning joint space trajectories of a multi-axis device. Background Art
[0002] A robot is a multi-axis device, which is often divided into several axes for independent feeding. The actual motion trajectory is the combined motion of several axes. During the trajectory planning process, it is necessary to ensure that each axis reaches the specified position at the same time.
[0003] The forward solution of kinematics refers to the calculation of the robot's terminal posture given the coordinates of each axis in its own joint space. The inverse solution of kinematics refers to the calculation of the position of each axis in its own joint space given the terminal posture of the robot. It is the basis of robot motion planning and trajectory control. There are three inverse solution methods for kinematic models. One is to analytically calculate the coordinates of each axis in its own joint space. Another method is numerical iteration (its essence is an optimization process, which calculates a specific solution to the equation but not all solutions). The last method is a geometric method, which is only applicable to some robots with simpler structures.
[0004] When the prior art is planning the trajectory of a multi-axis device, some technical solutions give the acceleration time, uniform speed time, and deceleration time of the speed planner respectively, and each axis accelerates, uniforms, and decelerates according to the given time to achieve the purpose of multi-axis synchronization, but this method does not consider the motion constraints, so it often causes some axes to fail to meet the motion constraints or meet the constraints but cause a waste of motion time; some technical solutions select the axis with the longest time as the reference axis, and the remaining axes accelerate, uniformly, and decelerate according to the time of the reference axis to achieve multi-axis synchronization, but this method can only ensure that the reference axis meets the motion constraints, and cannot ensure whether the remaining axes meet; there are also technical solutions that select the longest acceleration time, the longest uniform speed time, and the longest deceleration time from all acceleration times, all uniform speed times, and all deceleration times as the final acceleration time, uniform speed time, and deceleration time of each axis, and accelerate, uniformly, and decelerate according to this time to achieve multi-axis synchronization, but this method often causes a waste of motion time and reduces the work efficiency of the robot. In short, when the prior art is planning the trajectory of a multi-axis device, it is impossible to both meet the motion constraints and enable the multi-axis device to perform at its best performance.
[0005] Therefore, a trajectory planning method is needed to satisfy the motion constraints and enable the axes of the entire multi-axis device to run synchronously when performing trajectory planning for the multi-axis device, thereby improving the operating performance of the multi-axis device. Summary of the invention
[0006] In view of this, an embodiment of the present invention provides a method and device for planning the joint space trajectory of a multi-axis device, the method comprising: obtaining the coordinates of each joint node of the multi-axis device in the joint space; under the kinematic constraints of each axis, performing a first trajectory planning for each axis according to the coordinates, obtaining the planning time for each axis to reach each joint node, and determining the synchronization time of each joint node accordingly; under the kinematic constraints, performing a second trajectory planning for each axis according to the synchronization time and the coordinates, obtaining the trajectory of each axis in the joint space. The technical solution of the present invention is suitable for trajectory planning of various general axes in the joint space, and enables each axis to operate synchronously under the kinematic constraints of each axis of the multi-axis device, thereby improving the overall operation performance of the multi-axis device.
[0007] In the first aspect, an embodiment of the present invention provides a method for planning the joint space trajectory of a multi-axis device, comprising: obtaining the coordinates of each joint node of the multi-axis device in the joint space, each axis of the multi-axis device being a dimension of the joint space; under the kinematic constraints of each axis, performing a first trajectory planning for each axis according to the coordinates, obtaining the planning time for each axis to reach each joint node, and determining the synchronization time of each joint node accordingly, wherein the synchronization time of a joint node is the time for each axis to arrive at the joint node at the same time; under the kinematic constraints, performing a second trajectory planning for each axis according to the synchronization time and the coordinates, to obtain the trajectory of each axis in the joint space.
[0008] From the above, compared with the trajectory planning of the prior art which only synchronizes the overall running time or the time synchronization of each speed change stage, the technical solution of the embodiment of the present invention improves the running performance of the multi-axis device by making each axis run synchronously under the condition that the operation of each axis of the multi-axis device obeys the kinematic constraints, and is suitable for the trajectory planning of various general axes in the joint space.
[0009] In a possible implementation of the first aspect, the first trajectory planning includes: obtaining the inflection point of each axis according to the coordinates, the inflection point of an axis being a joint node whose speed is 0 in the coordinate dimension corresponding to the axis in the joint space; under the kinematic constraints, planning the trajectory of each axis between every two adjacent inflection points through speed planning to obtain the planning time.
[0010] From the above, the first trajectory planning is achieved by each axis planning itself under the kinematic constraints, so that the motion performance of each axis is optimized.
[0011] In a possible implementation of the first aspect, the synchronization time of each joint node is obtained based on this, including: according to the planning time, obtaining the running time of each axis between each two adjacent joint nodes in the trajectory of the first trajectory planning; for any two adjacent joint nodes, comparing the running time of each axis between the two adjacent joint nodes, and selecting the longest running time as the synchronization time between the two adjacent joint nodes; obtaining the synchronization time according to the synchronization time, wherein the synchronization time of a joint node is the synchronization time between the two adjacent joint nodes superimposed on the synchronization time of the previous adjacent joint node of the joint node.
[0012] From the above, for any two adjacent joint nodes, the longest running time is selected from the running time of each axis as the synchronization time between the two adjacent joint nodes. This synchronization time makes each axis meet the kinematic constraints, and the overall running performance of the multi-axis device is optimized by optimizing the motion performance of the most restricted axis (i.e. the axis with the longest running time).
[0013] In a possible implementation of the first aspect, the second trajectory planning includes: under the kinematic constraints, planning the trajectory between every two adjacent inflection points of each axis through speed planning according to the synchronization time and the coordinates, and in the planning process, the continuity of the speed, acceleration or jerk of each axis at each joint node is used as a convergence condition.
[0014] From the above, compared with the trajectory planning of the prior art which only realizes the continuity of speed and acceleration, the second trajectory planning of the present invention increases the continuity of jerk and reduces the vibration of each axis.
[0015] In a possible implementation of the first aspect, the second trajectory planning also includes: when the speed, acceleration or jerk of a certain axis at a certain joint node is still discontinuous after the second trajectory planning of a set time, smoothing filtering is used to make the speed, acceleration and jerk of each axis at each joint node continuous.
[0016] From the above, in the second trajectory planning, by combining the planning with the filtering with the set time, the planning accuracy is achieved, the continuity of the speed, acceleration and jerk of each axis at each joint node is improved, and the timeliness of the planning is improved.
[0017] In a possible implementation of the first aspect, in the velocity planning, an expression using time cosine as a basis function is used to represent the relationship between the coordinates of each axis in the joint space and time.
[0018] From the above, speed planning uses the time cosine as the basis function to express the speed, without defining the time of each speed change node, thus improving the accuracy of planning.
[0019] In a possible implementation manner of the first aspect, the kinematic constraint condition includes a maximum allowable speed, a maximum allowable acceleration, or a maximum allowable jerk of each axis.
[0020] From the above, during the first trajectory planning, each axis complies with its own kinematic constraints, so that the trajectory of each axis in the planning can achieve its own optimal performance. During the second trajectory planning, each axis complies with its own kinematic constraints on the basis of time synchronization, so that the overall operating performance of the multi-axis equipment is improved.
[0021] In the second aspect, an embodiment of the present invention provides a planning device for the joint space trajectory of a multi-axis device, comprising: an acquisition module, a time synchronization module and a speed matching module; the acquisition module is used to obtain the coordinates of each joint node of the multi-axis device in the joint space, and each axis of the multi-axis device is a dimension of the joint space; the time synchronization module is used to perform a first trajectory planning for each axis according to the coordinates under the kinematic constraints of each axis, obtain the planning time for each axis to reach each joint node, and determine the synchronization time of each joint node accordingly, wherein the synchronization time of a joint node is the time for each axis to arrive at the joint node at the same time; the speed matching module is used to perform a second trajectory planning for each axis according to the synchronization time and the coordinates under the kinematic constraints, and obtain the trajectory of each axis in the joint space.
[0022] From the above, compared with the trajectory planning of the prior art which only synchronizes the overall running time or the time synchronization of each speed change stage, the technical solution of the embodiment of the present invention improves the running performance of the multi-axis device by making each axis run synchronously under the condition that the operation of each axis of the multi-axis device obeys the kinematic constraints, and is suitable for the trajectory planning of various general axes in the joint space.
[0023] In a possible implementation of the second aspect, when the time synchronization module performs the first trajectory planning, it specifically includes: obtaining the inflection point of each axis according to the coordinates, the inflection point of an axis being a joint node whose speed is 0 in the coordinate dimension corresponding to the axis in the joint space; under the kinematic constraints, planning the trajectory of each axis between every two adjacent inflection points through speed planning to obtain the planning time.
[0024] From the above, the first trajectory planning is achieved by each axis planning itself under the kinematic constraints, so that the motion performance of each axis is optimized.
[0025] In a possible implementation of the second aspect, when the time synchronization module obtains the synchronization time of each joint node, it specifically includes: obtaining the running time of each axis between each two adjacent joint nodes in the trajectory of the first trajectory planning according to the planning time; for any two adjacent joint nodes, comparing the running time of each axis between the two adjacent joint nodes, and selecting the longest running time as the synchronization time between the two adjacent joint nodes; obtaining the synchronization time according to the synchronization time, wherein the synchronization time of a joint node is the synchronization time between the two adjacent joint nodes superimposed on the synchronization time of the previous adjacent joint node of the joint node.
[0026] From the above, for any two adjacent joint nodes, the longest running time is selected from the running time of each axis as the synchronization time between the two adjacent joint nodes. This synchronization time makes each axis meet the kinematic constraints, and the overall running performance of the multi-axis device is optimized by optimizing the motion performance of the most restricted axis (i.e. the axis with the longest running time).
[0027] In a possible implementation of the second aspect, when the speed matching module performs the second trajectory planning, it specifically includes: under the kinematic constraints, planning the trajectory between every two adjacent inflection points of each axis through speed planning according to the synchronization time and the coordinates, and in the planning process, the speed, acceleration or jerk of each axis at each joint node is continuous as a convergence condition.
[0028] From the above, compared with the trajectory planning of the prior art which only realizes the continuity of speed and acceleration, the second trajectory planning of the present invention increases the continuity of jerk and reduces the vibration of each axis.
[0029] Furthermore, compared with the trajectory planning of the prior art which only realizes the continuity of speed and acceleration, the second trajectory planning of the present invention increases the continuity of jerk and reduces the vibration of each axis.
[0030] In a possible implementation of the second aspect, the speed matching module, when performing the second trajectory planning, further specifically includes: when the speed, acceleration or jerk of a certain axis at a certain joint node is still discontinuous after the second trajectory planning after a set time, smoothing filtering is used to make the speed, acceleration and jerk of each axis at each joint node continuous.
[0031] From the above, in the second trajectory planning, by combining the planning with the filtering with the set time, the planning accuracy is achieved, the continuity of the speed, acceleration and jerk of each axis at each joint node is improved, and the timeliness of the planning is improved.
[0032] In a possible implementation of the second aspect, in a possible implementation of the first aspect, in the velocity planning, an expression using time cosine as a basis function is used to represent the relationship between the coordinates of each axis in the joint space and time.
[0033] From the above, speed planning uses the time cosine as the basis function to express the speed, without defining the time of each speed change node, thus improving the accuracy of planning.
[0034] In a possible implementation manner of the second aspect, the kinematic constraint condition includes a maximum allowable speed, a maximum allowable acceleration, or a maximum allowable jerk of each axis.
[0035] From the above, during the first trajectory planning, each axis complies with its own kinematic constraints, so that the trajectory of each axis in the planning can achieve its own optimal performance. During the second trajectory planning, each axis complies with its own kinematic constraints on the basis of time synchronization, so that the overall operating performance of the multi-axis equipment is improved.
[0036] In a third aspect, an embodiment of the present invention provides a computing device, including:
[0037] bus;
[0038] A communication interface connected to the bus;
[0039] at least one processor connected to the bus; and
[0040] At least one memory is connected to the bus and stores program instructions, and when the program instructions are executed by the at least one processor, the at least one processor executes any implementation of the first aspect of the present invention.
[0041] In a fourth aspect, an embodiment of the present invention provides a computer-readable storage medium having program instructions stored thereon, wherein when the program instructions are executed by a computer, the computer executes any implementation method described in the first aspect of the application. BRIEF DESCRIPTION OF THE DRAWINGS
[0042] Figure 1 It is a flow chart of a first embodiment of a method for planning a joint space trajectory of a multi-axis device of the present invention;
[0043] Figure 2 It is a flow chart of a second embodiment of a method for planning a joint space trajectory of a multi-axis device of the present invention;
[0044] Figure 3 A schematic flow chart of a method for determining a synchronization time in Embodiment 2 of a method for planning a joint space trajectory of a multi-axis device of the present invention;
[0045] Figure 4 A schematic flow chart of a speed matching method of Embodiment 2 of a method for planning a joint space trajectory of a multi-axis device of the present invention;
[0046] Figure 5 It is a structural schematic diagram of a first embodiment of a planning device for joint space trajectory of a multi-axis device of the present invention;
[0047] Figure 6 It is a structural schematic diagram of a second embodiment of a joint space trajectory planning device for a multi-axis device of the present invention;
[0048] Figure 7 A schematic diagram of the structure of a computing device according to various embodiments of the present invention. DETAILED DESCRIPTION
[0049] In the following description, reference is made to “some embodiments”, which describe a subset of all possible embodiments, but it will be understood that “some embodiments” may be the same subset or different subsets of all possible embodiments and may be combined with each other without conflict.
[0050] In the following description, the terms "first\second\third, etc." or module A, module B, module C, etc. are only used to distinguish similar objects, or to distinguish different embodiments, and do not represent a specific ordering of the objects. It can be understood that the specific order or sequence can be interchanged where permitted, so that the embodiments of the present invention described here can be implemented in an order other than that illustrated or described here.
[0051] In the following description, the numbers representing the steps, such as S110, S120, etc., do not necessarily mean that the steps must be executed in this manner. If permitted, the order of the previous and next steps can be interchanged, or the steps can be executed simultaneously.
[0052] Unless otherwise defined, all technical and scientific terms used herein have the same meaning as those commonly understood by those skilled in the art to which the present invention belongs. The terms used herein are only for the purpose of describing the embodiments of the present invention and are not intended to limit the present invention.
[0053] Cartesian space, Cartesian space coordinates: Cartesian space is a rectangular coordinate space. The coordinates of Cartesian space are posture, including position coordinates and attitude coordinates. The position coordinates are three-dimensional rectangular coordinates, and the attitude coordinates are the rotation angle of the current position of the object relative to the three-dimensional rectangular coordinates. Schematically, the attitude can be expressed by the three angular coordinates of Euler angles.
[0054] Joint space, joint space coordinates: Joint space is the motion space of each axis of a multi-axis device. Each axis is one dimension of the joint space. Each axis is a universal axis and can be a translation or rotation. The joint space coordinates are the displacement or rotation angle of the axis.
[0055] Trajectory: The relationship between the coordinates and time of a moving object. The Cartesian space trajectory is the relationship between the Cartesian space coordinates and time, and the joint space trajectory is the relationship between the joint space coordinates and time.
[0056] Kinematic constraints: including the maximum allowable speed, maximum allowable acceleration, and maximum allowable jerk. For a specific axis, the kinematic constraints are the constraints of the axis's joint space. When an axis is a translation axis, its kinematic constraints are the maximum allowable speed, maximum allowable acceleration, and maximum allowable jerk in terms of displacement; when an axis is a rotation axis, its kinematic constraints are the maximum allowable speed, maximum allowable acceleration, and maximum allowable jerk in terms of rotation.
[0057] Velocity planner: A device for planning the trajectory and velocity of a moving object. It plans the velocity and trajectory of an object by trajectory interpolation. When planning velocity, it keeps the velocity and acceleration of each point continuous and obeys the kinematic constraints. The velocity planner can plan trajectories in Cartesian space as well as in joint space. When planning, the velocity is described as an expression of time, for example, a polynomial based on time.
[0058] The technical solutions of the embodiments of the present invention include: obtaining the coordinates of each joint node of the multi-axis device in the joint space, and performing secondary trajectory planning for each axis according to the coordinates under the kinematic constraints of each axis. The first trajectory planning determines the synchronization time of each joint node, and the second trajectory planning achieves the movement speed of each axis that matches the synchronization time, and obtains the final trajectory in the joint space. The technical solutions of the embodiments of the present invention are suitable for the trajectory planning of various general axes in the joint space, and each axis of the multi-axis device is made to run synchronously under the kinematic constraints of each axis, thereby improving the overall operating performance of the multi-axis device. In some embodiments, the acceleration of each axis at the joint node is continuous, and the drive motor of each axis is suppressed to reduce the vibration of each axis.
[0059] The following describes, in conjunction with the accompanying drawings, a method embodiment, a device embodiment, and other related embodiments of planning the joint space trajectory of a multi-axis device of the present invention.
[0060] The multi-axis device in the present invention has multiple axes, which can be a robot or a machine tool. Its trajectory node is the key point of the end of the multi-axis device in Cartesian space; the end of the multi-axis device can be the external operation part of the multi-axis device, such as the finger of a robot, the tool of a machine tool, the mechanical arm of a tower crane, etc.; the joint node of the multi-axis device is the point reached by each axis of the multi-axis device in the joint space when the end of the multi-axis device reaches the trajectory node.
[0061] Below we first combine the attached Figures 1 to 4 Various embodiments of a planning method for the joint space trajectory of a multi-axis device are introduced.
[0062] A method for planning the joint space trajectory of a multi-axis device in embodiment 1 includes: obtaining the coordinates of each joint node of the multi-axis device in the joint space; under the kinematic constraints of each axis, performing a first trajectory planning for each axis according to the coordinates, obtaining the planning time for each axis to reach each joint node, and determining the synchronization time of each joint node accordingly; under the kinematic constraints, performing a second trajectory planning for each axis according to the synchronization time and the coordinates, obtaining the trajectory of each axis in the joint space. Embodiment 1 of this method is suitable for trajectory planning of various general axes in the joint space, and enables each axis to operate synchronously under the kinematic constraints of each axis of the multi-axis device, thereby improving the overall operation performance of the multi-axis device.
[0063] Figure 1 The flowchart of a first embodiment of a method for planning a joint space trajectory of a multi-axis device is shown, including steps S110 to S130.
[0064] S110: Obtain coordinates of each joint node in the joint space, where each axis of the multi-axis device is a dimension of the joint space.
[0065] Schematically, the joint node coordinates in the joint space form an N*M dimensional matrix, where N represents N joint nodes and M represents M axes.
[0066] The coordinates of the joint nodes in the joint space can be obtained by inverse kinematics according to the posture of the multi-axis device end. In some embodiments, the posture of the multi-axis device end is obtained by trajectory planning of the multi-axis device end.
[0067] The axes of the multi-axis device are universal axes, including translation axes and / or rotation axes. Schematically, the node coordinates of a translation axis, such as the axis of a cylinder, are the translation displacements, and the node coordinates of a rotation axis, such as the axis of a motor, are the rotation angles.
[0068] The kinematic constraints are used to constrain the trajectory on each axis, and each axis has a corresponding kinematic constraint. In each embodiment of the present invention, kinematic constraints are used in the subsequent first trajectory planning and the second trajectory planning.
[0069] The sampling period is the granularity of describing time in various embodiments of the present invention. For example, the sampling period is the driving pulse period of the axis.
[0070] S120: Under the kinematic constraints of each axis of the multi-axis device, perform the first trajectory planning for each axis according to the coordinates of each joint node, obtain the planning time for each axis to reach each joint node, and determine the synchronization time of each joint node accordingly.
[0071] The synchronization time of a joint node is the time when each axis arrives at the joint node at the same time, that is, the coordinates when each axis arrives at the joint node synchronously at the synchronization time of a joint node represent the positions of each axis.
[0072] The kinematic constraints are used to constrain the trajectory on each axis, and each axis has a corresponding kinematic constraint. In each embodiment of the present invention, the subsequent first trajectory planning and second trajectory planning are subject to the kinematic constraints.
[0073] Among them, during the first trajectory planning, the speed planner is used to obtain the relationship between the coordinates of each joint node and time through speed planning, so as to complete the first trajectory planning. The speed planner can describe the relationship between the speed and time of each dimension by using an S-shaped curve, that is, S-shaped acceleration and deceleration to plan the speed, or it can plan the speed according to other shape lines such as trapezoidal lines. The speed planner can use a polynomial based on time to describe the relationship between speed and time, or it can use an expression based on the cosine function of time to describe the relationship between speed and time.
[0074] Among them, because the trajectory describes the relationship between the coordinates and time of the joint space, the planning time for each axis to reach each joint node can be obtained according to the trajectory obtained by the first trajectory planning. For any two adjacent joint nodes, the planning time for an axis to reach the latter of the two adjacent joint nodes is subtracted from the planning time for the axis to reach the former of the two adjacent joint nodes to obtain the running time of the axis between the two adjacent joint nodes.
[0075] Among them, for any two adjacent joint nodes, the running time of each axis between the two adjacent joint nodes is compared, and the longest running time is selected as the synchronization time of each axis of the multi-axis device between the two adjacent joint nodes. According to the synchronization time, the synchronization time of the multi-axis device terminal reaching each joint node is obtained. The synchronization time of a joint node is the synchronization time between the two adjacent joint nodes superimposed on the synchronization time of the previous adjacent joint node of the joint node.
[0076] S130: Under the kinematic constraints of each axis of the multi-axis device, perform a second trajectory planning for each axis according to the coordinates of each joint node and the synchronization time to obtain the trajectory of each axis in the joint space.
[0077] Among them, the trajectory of each axis in the joint space constitutes the trajectory of the multi-axis device in the joint space.
[0078] Among them, the second trajectory planning uses the speed planner introduced in step S120 to perform the second trajectory planning on the spatial trajectory of each axis joint, and the planning also complies with the following conditions: 1) the time for each axis to reach each joint node during the planning process is the corresponding synchronization time; 2) the speed, acceleration or jerk of each axis at each joint node is continuous.
[0079] In order to achieve continuity of the speed, acceleration or jerk of each axis at each joint node, in some embodiments, it is achieved by increasing the planning time and performing a sufficient number of iterations of the forward speed planning. In other embodiments, it is achieved through multiple iterations of the forward speed planning and filtering.
[0080] In summary, a method for planning the joint space trajectory of a multi-axis device in embodiment 1 performs a first trajectory planning for each axis according to the coordinates of each joint node of the multi-axis device in the joint space under the kinematic constraints of each axis, obtains the planning time for each axis to reach each joint node, and determines the synchronization time of each joint node accordingly, and performs a second trajectory planning for each axis according to the synchronization time and the coordinates to obtain the trajectory of each axis in the joint space. Embodiment 1 of this method is suitable for trajectory planning of various general axes in the joint space, and enables each axis to operate synchronously under the kinematic constraints of each axis of the multi-axis device, thereby improving the overall operation performance of the multi-axis device.
[0081] Below we first combine the attached Figures 2 to 4 A second embodiment of a method for planning joint space trajectories of a multi-axis device is introduced.
[0082] Embodiment 2 of a method for planning the joint space trajectory of a multi-axis device is based on embodiment 1 of a method for planning the joint space trajectory of a multi-axis device. During the first trajectory planning, the running time of the axis with the longest running time between every two adjacent nodes is selected as the synchronization time to optimize the motion performance of at least one axis. During the second trajectory planning, the second trajectory planning with a set length plus filtering method is used to not only achieve continuity of the speed, acceleration or jerk of each axis reaching each joint node, but also high planning efficiency. In addition, in both trajectory planning processes, an expression using time cosine as the basis function is selected to describe the speed, which further improves the planning accuracy.
[0083] Figure 2The flowchart of Embodiment 2 of a method for planning a joint space trajectory of a multi-axis device is shown, including steps S210 to S240.
[0084] S210: Obtain the position and posture, kinematic constraints, and calculation time granularity of the path node at the end of the multi-axis device.
[0085] Among them, the path nodes are several key points in the running path of the multi-axis device terminal in the Cartesian space, which are used to plan the trajectory of the multi-axis device terminal in the Cartesian space. The path nodes are obtained according to the key positions of the multi-axis device terminal in the actual scene.
[0086] The calculation time granularity is the minimum time interval used in trajectory planning. The smaller the granularity, the smoother the calculated trajectory, but the greater the amount of calculation. Generally, the drive pulse period of the axis is used as the sampling period.
[0087] For the kinematic constraint conditions, please refer to the description of step S110 in the first embodiment of the method for planning the joint space trajectory of a multi-axis device.
[0088] S220: Plan the trajectory of the end of the multi-axis device in the Cartesian space according to the position and posture of the path node, and obtain the coordinates of the joint nodes of the multi-axis device in the joint space by inverse kinematics solution.
[0089] Among them, the trajectory of the end of the multi-axis device in the Cartesian space is planned according to the posture of the path node of the end of the multi-axis device. In some embodiments, it is achieved through two steps of path planning and trajectory planning in Cartesian space. In other embodiments, it is achieved in one step through trajectory planning in Cartesian space. This is not limited in the present embodiment.
[0090] Among them, the joint nodes of the joint space correspond to the trajectory nodes on the Cartesian space trajectory, and the trajectory nodes are key points on the Cartesian space trajectory, which determine the trend of the Cartesian space trajectory.
[0091] The coordinates of each joint node in the joint space are obtained by inverse kinematics solution, and the inverse kinematics solution methods include analytical method, iterative method and geometric method, which are not limited in this embodiment.
[0092] The coordinates of each joint node in the joint space obtained at this time may be obtained in step S110 of the first embodiment of a method for planning a joint space trajectory of a multi-axis device.
[0093] S230: Under the kinematic constraints of each axis of the multi-axis device, perform the first trajectory planning for each axis according to the coordinates of each joint node, obtain the planning time for each axis to reach each joint node, and determine the synchronization time of each joint node accordingly.
[0094] Among them, this step is based on step S120 of embodiment 1 of a planning method for the joint space trajectory of a multi-axis device. By keeping the speed of each axis turning point at 0 for segmented planning, the planning accuracy of each axis is improved. At the same time, the speed planner plans the speed according to the S-shaped curve, that is, S-shaped acceleration and deceleration, and uses an expression based on the cosine function of time to describe the relationship between speed and time, thereby further improving the planning accuracy.
[0095] Among them, the detailed method of this step please refer to the synchronization time determination method of Example 2 of a planning method for the joint space trajectory of a multi-axis device, which will not be described in detail here.
[0096] S240: Under the kinematic constraints of each axis of the multi-axis device, perform a second trajectory planning for each axis according to the coordinates and synchronization time of each joint node to obtain the trajectory of each axis in the joint space.
[0097] Among them, this step is based on step S120 of embodiment 1 of a method for planning the joint space trajectory of a multi-axis device, and also improves the continuity of the speed, acceleration and jerk of each axis at each joint node through filtering, and describes the relationship between speed and time using an expression based on the cosine function of time.
[0098] Among them, the detailed method of this step please refer to the speed matching method of embodiment 2 of a method for planning the joint space trajectory of a multi-axis device, which will not be described in detail here.
[0099] Figure 3 The flowchart of the synchronization time determination method of Embodiment 2 of the method for planning the joint space trajectory of a multi-axis device is shown, that is, step 230 includes steps S2310 to S2350.
[0100] S2310: Obtain the inflection point of each axis according to the coordinates of each joint node.
[0101] The inflection point of an axis is the point where the velocity of the axis in the joint space is zero. It is the turning point between the forward and reverse motion of the axis and is also called the anchor point. The inflection point of the axis can be obtained by analyzing the coordinate changes between the joint nodes of each axis. The methods for obtaining the inflection point include differential method, comparison method, etc.
[0102] Among them, the inflection point of an axis also includes the first and last joint nodes of the axis. At these two joint nodes, the velocity of the joint space is also 0.
[0103] S2320: Under kinematic constraints, the velocity planner is used to perform the first trajectory planning for the joint space trajectory between every two adjacent inflection points of each axis to obtain the planning time for each axis to reach each joint node.
[0104] In the first trajectory planning process, each axis is planned separately, and the speed between every two adjacent turning points of each axis is planned by the rate planner, so as to obtain the trajectory between every two adjacent turning points of each axis. When planning by turning points, keep the speed of each axis at each turning point as 0.
[0105] Among them, in the process of speed planning, S-curve is used for planning under kinematic constraints, and the relationship between speed and time is expressed by an expression with time cosine as the basis function. The expression can be a polynomial with time cosine as the basis function or other forms.
[0106] From the above, the speed planner using the expression with time cosine as the basis function automatically plans according to the S-shaped curve, and there is no need to manually set the time-based segmentation of the S-shaped curve in advance. For example, there is no need to manually set the time of each time period such as increasing acceleration, uniform acceleration, decreasing acceleration, uniform speed, increasing and decreasing deceleration, uniform deceleration, decreasing deceleration, etc. The planned trajectory is more accurate, and the motion performance of each axis is optimized under the kinematic constraints.
[0107] S2330: According to the planned time for each axis to reach each joint node, obtain the running time of each axis between every two adjacent joint nodes.
[0108] Among them, the motion performance of each axis reaches the best under the kinematic constraints during a trajectory planning. The running time of each axis between each two adjacent joint nodes determined by the time each axis reaches each joint node is also the optimal running time of each axis.
[0109] S2340: For any two adjacent joint nodes, compare the running time of each axis between the two adjacent joint nodes, and select the longest running time as the synchronization time between the two adjacent joint nodes.
[0110] From the above, the synchronization duration between any two adjacent joint nodes determined by the above method ensures that at least one axis has the best performance between the two adjacent joint nodes, thereby achieving the best performance between the two adjacent joint nodes of the entire multi-axis device under the kinematic constraints. Because at this time, if the operating time of the entire multi-axis device between the two adjacent joint nodes is shortened, one of the axes will exceed its kinematic constraints.
[0111] S2350: Obtain the synchronization time of each joint node in turn according to the determined synchronization duration.
[0112] The synchronization time of a joint node is the synchronization time of the last adjacent joint node of the joint node superimposed on the synchronization time between the two adjacent joint nodes.
[0113] Schematically, let the time of the first joint node, i.e. the starting point, be t. Since the starting time of each axis is the same, t can also be considered as the synchronization time of the first joint node. Subsequently, the synchronization time with the next joint node is superimposed on t in sequence, thereby obtaining the synchronization time of each joint node in sequence.
[0114] From the above, according to the determined synchronization time, each axis of the multi-axis device reaches the specified position at the same time, complies with the kinematic constraints, and the operating performance is optimized.
[0115] Figure 4 The flow of a speed matching method of Embodiment 2 of a method for planning a joint space trajectory of a multi-axis device is shown, that is, step 240 includes steps S2410 to S2440.
[0116] Each axis of the multi-axis device runs the steps of this embodiment to perform planning. For the convenience of description, the axis currently being planned is called the planning axis.
[0117] S2410: Under kinematic constraints, according to the coordinates and synchronization time of each joint node, the velocity planner is used to perform a second trajectory planning on the joint space trajectory between every two adjacent inflection points of the planned axis to obtain the velocity, acceleration and jerk of the planned axis at each joint node.
[0118] Among them, in the second trajectory planning, the time when the planned axis reaches any joint node is the synchronization time of the joint node, so as to achieve the matching of the speeds of each axis of the multi-axis device, that is, each axis reaches each joint node synchronously according to the speed after matching each axis (that is, the speed after the second trajectory planning). A more detailed description is that each axis reaches the coordinates corresponding to each dimension of each axis in each joint node synchronously. And in the second trajectory planning, the planning convergence condition is that the speed, acceleration or jerk of the planned axis in each joint node in the joint space is continuous.
[0119] In the planning process, the speed of the inflection point of the planning axis in the joint space is also kept at 0, and the S-shaped curve is used for planning under the kinematic constraints.
[0120] The relationship between speed and time during planning is expressed by an expression with time cosine as the basis function. The expression can be a polynomial with time cosine as the basis function or other forms.
[0121] From the above, the speed planner using the expression with time cosine as the basis function automatically plans according to the S-shaped curve, without the need to manually pre-set the time-based segmentation of the S-shaped curve, thereby improving the accuracy of the second trajectory planning.
[0122] From the above, it can be seen that the prior art only realizes the continuity of speed and acceleration, while the present embodiment adds the continuity of jerk, thereby suppressing the vibration problem of each axis.
[0123] S2420: After the set secondary trajectory planning time has passed, determine whether there is a jump joint node in the planned axis.
[0124] If it exists, execute step S2430, otherwise execute step S2440.
[0125] The jumping joint node of an axis is that the velocity, acceleration or jerk of the axis at the joint node is discontinuous.
[0126] Among them, the second trajectory planning includes multiple rounds of forward speed planning. Each round of forward speed planning selects multiple forward interpolation points and uses forward and / or reverse search methods to perform complex speed planning calculations. The amount of calculation is large. In order to ensure the timeliness of operation, it is necessary to set a duration for the second trajectory planning.
[0127] S2430: Make the velocity, acceleration and jerk of the jump joint nodes of the planned axis continuous through filtering.
[0128] Among them, the filtering methods include polynomial filtering or average value filtering.
[0129] From the above, the duration of the second trajectory planning is controlled by adding filtering to meet the time requirements of the actual scene and improve the continuity of the speed, acceleration and jerk of each axis at the joint node.
[0130] S2440: Output the currently planned trajectory as the joint space trajectory of the planned axis of the multi-axis device.
[0131] Among them, after completing the joint space trajectory planning of the current planned axis of the multi-axis device, the next unplanned axis is selected as the planned axis to continue planning.
[0132] In summary, a second embodiment of a method for planning the joint space trajectory of a multi-axis device is based on the first embodiment of a method for planning the joint space trajectory of a multi-axis device. During the first trajectory planning, the running time of the axis with the longest running time between every two adjacent nodes is selected as the synchronization time to optimize the motion performance of at least one axis. During the second trajectory planning, the second trajectory planning with a set length plus filtering method is used to not only achieve continuity of the speed, acceleration or jerk of each axis reaching each joint node, but also high planning efficiency. In addition, in the two trajectory planning processes, an expression with time cosine as the basis function is selected to describe the speed, which further improves the planning accuracy.
[0133] The following is combined with Figure 5 and Figure 6An embodiment of a planning device for joint space trajectory of a multi-axis device of the present invention is introduced.
[0134] Figure 5 The structure of a first embodiment of a planning device for joint space trajectory of a multi-axis device is shown, including: an acquisition module 510, a time synchronization module 520 and a speed matching module 530.
[0135] The acquisition module 510 is used to acquire the coordinates of each joint node in the joint space, and each axis of the multi-axis device is a dimension of the joint space. For its method and advantages, please refer to step S110 of the first embodiment of a method for planning joint space trajectory of a multi-axis device.
[0136] The time synchronization module 520 is used to perform the first trajectory planning for each axis according to the coordinates of each joint node under the kinematic constraint conditions of each axis of the multi-axis device, obtain the planning time for each axis to reach each joint node, and determine the synchronization time of each joint node accordingly. For its method and advantages, please refer to step S120 of the first embodiment of a method for planning the joint space trajectory of a multi-axis device.
[0137] The speed matching module 530 is used to perform a second trajectory planning for each axis according to the coordinates and synchronization time of each joint node under the kinematic constraints of each axis of the multi-axis device, and obtain the trajectory of each axis in the joint space. For its method and advantages, please refer to step S130 of the first embodiment of a method for planning the joint space trajectory of a multi-axis device.
[0138] Figure 6 The structure of a second embodiment of a joint space trajectory planning device for a multi-axis device is shown, including: an acquisition module 610, an end trajectory planning module 620, a time synchronization module 630 and a speed matching module 640.
[0139] The acquisition module 610 is used for S210: acquiring the position, kinematic constraints and calculation time granularity of the path node at the end of the multi-axis device. For its method and advantages, please refer to step S210 of the second embodiment of a method for planning the joint space trajectory of a multi-axis device.
[0140] The terminal trajectory planning module 620 is used to plan the trajectory of the terminal of the multi-axis device in the Cartesian space according to the position of the path node, and obtain the coordinates of the joint nodes of the multi-axis device in the joint space by inverse kinematics. For its method and advantages, please refer to step S220 of the second embodiment of a method for planning the joint space trajectory of a multi-axis device.
[0141] The time synchronization module 630 is used to perform the first trajectory planning for each axis according to the coordinates of each joint node under the kinematic constraint conditions of each axis of the multi-axis device, obtain the planning time for each axis to reach each joint node, and determine the synchronization time of each joint node accordingly. For its method and advantages, please refer to step S230 of embodiment 2 of a method for planning the joint space trajectory of a multi-axis device.
[0142] The speed matching module 640 is used to perform a second trajectory planning for each axis according to the coordinates and synchronization time of each joint node under the kinematic constraints of each axis of the multi-axis device, and obtain the trajectory of each axis in the joint space. For its method and advantages, please refer to step S240 of embodiment 2 of a method for planning the joint space trajectory of a multi-axis device.
[0143] The present invention also provides a computing device, as follows: Figure 7 Detailed introduction.
[0144] The computing device 700 includes a processor 710 , a memory 720 , a communication interface 730 , and a bus 740 .
[0145] It should be understood that the communication interface 730 in the computing device 700 shown in this figure can be used to communicate with other devices.
[0146] The processor 710 may be connected to a memory 720. The memory 720 may be used to store the program code and data. Therefore, the memory 720 may be a storage unit inside the processor 710, or an external storage unit independent of the processor 710, or a component including a storage unit inside the processor 710 and an external storage unit independent of the processor 710.
[0147] Optionally, the computing device 700 may further include a bus 740. The memory 720 and the communication interface 730 may be connected to the processor 710 via the bus 740. The bus 740 may be a Peripheral Component Interconnect (PCI) bus or an Extended Industry Standard Architecture (EISA) bus. The bus 740 may be divided into an address bus, a data bus, a control bus, etc. For ease of representation, the figure is represented by only one line, but it does not mean that there is only one bus or one type of bus.
[0148] It should be understood that in the embodiment of the present invention, the processor 710 may adopt a central processing unit (CPU). The processor may also be other general-purpose processors, digital signal processors (DSP), application specific integrated circuits (ASIC), field programmable gate arrays (FPGA) or other programmable logic devices, discrete gates or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor or the processor may also be any conventional processor, etc. Alternatively, the processor 710 may adopt one or more integrated circuits to execute relevant programs to implement the technical solutions provided in the embodiment of the present invention.
[0149] The memory 720 may include a read-only memory and a random access memory, and provides instructions and data to the processor 710. A portion of the processor 710 may also include a nonvolatile random access memory. For example, the processor 710 may also store information on the device type.
[0150] When the computing device 700 is running, the processor 710 executes the computer-executable instructions in the memory 720 to perform the operation steps of each method embodiment.
[0151] It should be understood that the computing device 700 according to an embodiment of the present invention can correspond to the corresponding subjects in the methods according to the various embodiments of the present invention, and the above-mentioned and other operations and / or functions of each module in the computing device 700 are respectively for implementing the corresponding processes of each method in the embodiment of the present method. For the sake of brevity, they will not be repeated here.
[0152] Those skilled in the art will appreciate that the units and algorithm steps of each example described in conjunction with the embodiments disclosed herein can be implemented in electronic hardware, or a combination of computer software and electronic hardware. Whether these functions are performed in hardware or software depends on the specific application and design constraints of the technical solution. Professional and technical personnel can use different methods to implement the described functions for each specific application, but such implementation should not be considered to be beyond the scope of the present invention.
[0153] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working processes of the systems, devices and units described above can refer to the corresponding processes in the aforementioned method embodiments and will not be repeated here.
[0154] In the several embodiments provided by the present invention, it should be understood that the disclosed systems, devices and methods can be implemented in other ways. For example, the device embodiments described above are only schematic. For example, the division of the units is only a logical function division. There may be other division methods in actual implementation, such as multiple units or components can be combined or integrated into another system, or some features can be ignored or not executed. Another point is that the mutual coupling or direct coupling or communication connection shown or discussed can be through some interfaces, indirect coupling or communication connection of devices or units, which can be electrical, mechanical or other forms.
[0155] The units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in one place or distributed on multiple network units. Some or all of the units may be selected according to actual needs to achieve the purpose of the embodiment of the method.
[0156] In addition, each functional unit in each embodiment of the present invention may be integrated into one processing unit, or each unit may exist physically separately, or two or more units may be integrated into one unit.
[0157] If the functions are implemented in the form of software functional units and sold or used as independent products, they can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the present invention, or the part that contributes to the prior art or the part of the technical solution, can be embodied in the form of a software product. The computer software product is stored in a storage medium, including several instructions for a computer device (which can be a personal computer, a server, or a network device, etc.) to perform all or part of the steps of the decoding method described in each embodiment of the present invention. The aforementioned storage medium includes various media that can store program codes, such as a USB flash drive, a mobile hard disk, a read-only memory (ROM), a random access memory (RAM), a magnetic disk or an optical disk.
[0158] An embodiment of the present invention further provides a computer-readable storage medium on which a computer program is stored. When the program is executed by a processor, it is used to execute the operating steps of each method embodiment.
[0159] The computer storage medium of the embodiment of the present invention can adopt any combination of one or more computer-readable media. The computer-readable medium can be a computer-readable signal medium or a computer-readable storage medium. The computer-readable storage medium can be, for example, but not limited to, an electrical, magnetic, optical, electromagnetic, infrared, or semiconductor system, device or device, or any combination of the above. More specific examples (non-exhaustive list) of computer-readable storage media include, an electrical connection with one or more wires, a portable computer disk, a hard disk, a random access memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber, a portable compact disk read-only memory (CD-ROM), an optical storage device, a magnetic storage device, or any suitable combination of the above. In this document, a computer-readable storage medium can be any tangible medium containing or storing a program, which can be used by an instruction execution system, device or device or used in combination with it.
[0160] Computer-readable signal media may include data signals propagated in baseband or as part of a carrier wave, which carry computer-readable program code. Such propagated data signals may take a variety of forms, including but not limited to electromagnetic signals, optical signals, or any suitable combination of the above. Computer-readable signal media may also be any computer-readable medium other than a computer-readable storage medium, which may send, propagate, or transmit a program for use by or in conjunction with an instruction execution system, apparatus, or device.
[0161] The program code embodied on the computer readable medium may be transmitted using any appropriate medium, including but not limited to wireless, wireline, optical fiber cable, RF, etc., or any suitable combination of the foregoing.
[0162] Computer program code for performing the operations of the present invention may be written in one or more programming languages or a combination thereof, including object-oriented programming languages such as Java, Smalltalk, C++, and conventional procedural programming languages such as "C" or similar programming languages. The program code may be executed entirely on the user's computer, partially on the user's computer, as a separate software package, partially on the user's computer and partially on a remote computer, or entirely on a remote computer or server. In the case of a remote computer, the remote computer may be connected to the user's computer through any type of network, including a local area network (LAN) or a wide area network (WAN), or may be connected to an external computer (e.g., through the Internet using an Internet service provider).
[0163] Note that the above are only preferred embodiments of the present invention and the technical principles used. Those skilled in the art will understand that the present invention is not limited to the specific embodiments described herein, and that various obvious changes, readjustments and substitutions can be made by those skilled in the art without departing from the scope of protection of the present invention. Therefore, although the present invention has been described in more detail through the above embodiments, the present invention is not limited to the above embodiments, and may also include more other equivalent embodiments without departing from the concept of the present invention, all of which belong to the scope of protection of the present invention.
Claims
1. A method for planning the joint space trajectory of a multi-axis device, characterized in that: include: Obtaining the coordinates of each joint node of the multi-axis device in the joint space, each axis of the multi-axis device being a dimension of the joint space; Under the kinematic constraints of each axis, perform the first trajectory planning for each axis according to the coordinates, obtain the planning time for each axis to reach each joint node, and determine the synchronization time of each joint node accordingly, wherein the synchronization time of a joint node is the time for each axis to reach the joint node at the same time; Under the kinematic constraints, performing a second trajectory planning for each axis according to the synchronization time and the coordinates to obtain the trajectory of each axis in the joint space; The first trajectory planning includes: Obtaining the inflection point of each axis according to the coordinates, where the inflection point of an axis is a joint node whose speed is 0 in the coordinate dimension corresponding to the axis in the joint space; planning the trajectory of each axis between every two adjacent inflection points through speed planning under the kinematic constraint conditions to obtain the planning time; The first trajectory planning includes, when determining the synchronization time of each joint node: According to the planning time, the running time of each axis between each two adjacent joint nodes in the trajectory of the first trajectory planning is obtained, For any two adjacent joint nodes, the running time of each axis between the two adjacent joint nodes is compared, and the longest running time is selected as the synchronization time between the two adjacent joint nodes. The synchronization time is obtained according to the synchronization duration, wherein the synchronization time of a joint node is the synchronization duration between two adjacent joint nodes superimposed on the synchronization time of the last adjacent joint node of the joint node.
2. The method according to claim 1, characterized in that: The second trajectory planning includes: Under the kinematic constraints, the trajectory between every two adjacent inflection points of each axis is planned respectively through speed planning according to the synchronization time and the coordinates, and during the planning process, the continuity of the speed, acceleration or jerk of each axis at each joint node is used as a convergence condition.
3. The method according to claim 2, characterized in that: The second trajectory planning also includes: When the velocity, acceleration or jerk of a certain axis at a certain joint node is still discontinuous after the second trajectory planning after the set time, smoothing filtering is used to make the velocity, acceleration and jerk of each axis at each joint node continuous.
4. The method according to any one of claims 1 to 3, characterized in that: In the velocity planning, an expression using time cosine as a basis function is used to represent the relationship between the coordinates of each axis in the joint space and time.
5. The method according to any one of claims 1 to 3, characterized in that: The kinematic constraints include a maximum allowed velocity, a maximum allowed acceleration, or a maximum allowed jerk for each axis.
6. A device for planning joint space trajectories of a multi-axis device, characterized in that: include: Acquisition module, time synchronization module and speed matching module; The acquisition module is used to acquire the coordinates of each joint node of the multi-axis device in the joint space, and each axis of the multi-axis device is a dimension of the joint space; The time synchronization module is used to perform the first trajectory planning for each axis according to the coordinates under the kinematic constraints of each axis, obtain the planning time for each axis to reach each joint node, and determine the synchronization time of each joint node accordingly, wherein the synchronization time of a joint node is the time for each axis to reach the joint node at the same time; The speed matching module is used to perform a second trajectory planning for each axis according to the synchronization time and the coordinates under the kinematic constraint condition to obtain the trajectory of each axis in the joint space; When performing the first trajectory planning, the time synchronization module is specifically used to obtain the inflection point of each axis according to the coordinates, where the inflection point of an axis is a joint node whose speed is 0 in the coordinate dimension corresponding to the axis in the joint space; and is specifically used to plan the trajectory of each axis between every two adjacent inflection points through speed planning under the kinematic constraint conditions to obtain the planning time; When determining the synchronization time of each joint node, the time synchronization module is specifically used to include: According to the planning time, the running time of each axis between each two adjacent joint nodes in the trajectory of the first trajectory planning is obtained, For any two adjacent joint nodes, the running time of each axis between the two adjacent joint nodes is compared, and the longest running time is selected as the synchronization time between the two adjacent joint nodes. The synchronization time is obtained according to the synchronization duration, wherein the synchronization time of a joint node is the synchronization duration between two adjacent joint nodes superimposed on the synchronization time of the last adjacent joint node of the joint node.
7. A computing device, characterized in that include: bus; A communication interface connected to the bus; at least one processor connected to the bus; as well as At least one memory is connected to the bus and stores program instructions, and when the program instructions are executed by the at least one processor, the at least one processor executes the method according to any one of claims 1 to 5.
8. A computer-readable storage medium having program instructions stored thereon, characterized in that: When the program instructions are executed by a computer, the computer executes the method according to any one of claims 1 to 5.
Citation Information
Patent Citations
Multi-axis synchronous track planning method and system and computer readable storage medium
CN108890644A
Method and apparatus for planning path of industrial robot
JP2003241811A
