CN111002308A - Industrial mechanical arm path planning method based on segmented multistage polynomial interpolation - Google Patents
Industrial mechanical arm path planning method based on segmented multistage polynomial interpolation Download PDFInfo
- Publication number
- CN111002308A CN111002308A CN201911237104.3A CN201911237104A CN111002308A CN 111002308 A CN111002308 A CN 111002308A CN 201911237104 A CN201911237104 A CN 201911237104A CN 111002308 A CN111002308 A CN 111002308A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- polynomial
- order
- planning
- point
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Withdrawn
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
The invention discloses an industrial mechanical arm path planning method based on segmented multistage polynomial interpolation, which comprises the steps of establishing a mechanical arm mathematical model according to mechanical arm standard D-H parameters; determining an initial point, a termination point and a path intermediate point of the mechanical arm; carrying out segmentation processing on the path passing points; path planning is carried out on different sections by applying different-order polynomial interpolation algorithms to obtain planning curves; and combining the curves to obtain the whole path planning curve. According to the invention, aiming at different requirements on the motion characteristics of the mechanical arm in different environments, different-order polynomial interpolation algorithms are selected for segment path planning, so that under the condition of ensuring the operation precision of the mechanical arm, the operation efficiency of the algorithms is improved, the rigid impact at the joint of the mechanical arm is reduced, and the service life of the mechanical arm is prolonged.
Description
Technical Field
The invention relates to an industrial mechanical arm path planning method based on segmented multistage polynomial interpolation.
Background
With the development of robotics, industrial robots are becoming increasingly prominent in the manufacturing industry. Path planning is one of the hot topics in the field of robotics, and plays an important role in the development of industrial robots. The path planning problem mainly aims at that in a robot working space, a mechanical arm can stably and stably operate according to a preset middle path point. Compared with the traditional path planning algorithm, the path planning method has many calculation and analysis methods, and the balance between the operation cost and the performance is difficult to obtain.
Disclosure of Invention
The invention aims to provide an industrial mechanical arm path planning method based on segmented multi-order polynomial interpolation.
The technical scheme for realizing the purpose of the invention is as follows: an industrial mechanical arm path planning method based on segmented multistage polynomial interpolation comprises the following steps:
and 2, carrying out path planning on the sections obtained in the step 1 by using different-order polynomial interpolation functions to obtain different sections of planning curves, and arranging and integrating the different sections of planning curves according to the interval sequence to obtain a joint angular motion law diagram of the sampling points in the whole track.
Preferably, the specific steps of step 1 are:
step 1-1, establishing a mathematical model of a mechanical arm in a three-dimensional space according to a standard D-H parameter of a robot;
step 1-2, determining space coordinate points of the mechanical arm, wherein the space coordinate points comprise a starting point, an end point and a necessary middle path node in the motion process;
1-3, segmenting all spatial coordinate points;
and 1-4, reversely solving a joint angle value corresponding to the space coordinate point according to the space coordinate point.
Preferably, the number of segments is 3 or 4.
Preferably, the polynomial order selects the order of the first and last segments to be higher than the order of the remaining segments.
Preferably, the specific steps of step 2 are:
step 2-1, selecting polynomial interpolation functions of different orders for different sections, and selecting the angle q of each sectiondThe polynomial formula with respect to time t is:
qd=a0+a1t+a2t2+...antn
order 2N +1 selected according to a polynomial, angle q for each segmentdPerforming a N-order derivation with respect to the polynomial expression at time t;
combining the constraint conditions:
solving the polynomial general formula parameter a0,a1,a2...an;
Step 2-2, describing the polynomial as a function of the angle with respect to time t according to the obtained parameters and the polynomial order to obtain a time-varying rule graph of the M-section motion trail;
and 2-3, arranging and integrating the time-varying law graphs of the joint angular motion of each section according to the time sequence to generate a law graph of the joint angular motion of the sampling point in the whole track.
Compared with the prior art, the invention has the following remarkable advantages: according to the invention, through segmented analysis and respective processing, different polynomial interpolation algorithms are selected for calculation according to performance requirements, the calculation amount is reduced for the path section with low precision requirement, and the precision requirement can be fully met for the path section with high precision requirement.
Drawings
FIG. 1 is a flow chart of the present invention.
Figure 2 is a diagrammatic representation of a robotic arm of the present invention.
Fig. 3 is a characteristic diagram of the robot joint 1 according to the present invention with respect to each angle.
Detailed Description
As shown in fig. 1 to 3, a method for planning a path of an industrial mechanical arm based on piecewise multi-order polynomial interpolation includes the following steps:
step 1-1, establishing a mathematical model of the mechanical arm in a three-dimensional space according to standard D-H parameters of the robot, and converting the mathematical model of the three-dimensional space into a mathematical model only based on a joint angle theta from the D-H parameters of a serial mechanical arm with joints all being rotary jointsiAn equation of motion for a variable;
step 1-2, determining a space coordinate point of the mechanical arm, including a starting point, a terminating point and a necessary middle path node in the motion process, which are respectively expressed as: initial point (x)0,y0,z0) Intermediate path node (x)1,y1,z1)...(xn-1,yn-1,zn-1) End point (x)n,yn,zn);
Step 1-3, segmenting all spatial coordinate points according to an actual system, where the number of segments is M, and usually M is 3 or 4, for example: taking M as 3; segment 3 is represented as:
And 1-4, reversely solving the joint angle value corresponding to the spatial coordinate point according to the spatial coordinate point, and in some embodiments, calling an ikine () function library in Matlab software to realize reverse solution so as to obtain the joint angle value.
step 2-1, selecting polynomial interpolation functions of different orders for different sections, and selecting the angle q of each sectiondThe polynomial formulae with respect to time t can each be represented as:
qd=a0+a1t+a2t2+...antn
order 2N +1 selected according to a polynomial, angle q for each segmentdThe polynomial expression with respect to time t is subjected to an N-th order derivation.
Combining the constraint conditions:
can find a0,a1,a2...an。
Step 2-2, describing the polynomial as an angle q according to the parameters and the polynomial order obtained in the step, the function of time t is equal, and a time-varying rule graph of M motion tracks can be obtained;
and 2-3, arranging and integrating the time-varying law graphs of the joint angular motion of each section according to the time sequence to generate a law graph of the joint angular motion of the sampling point in the whole track.
According to the invention, aiming at different requirements on the motion characteristics of the mechanical arm in different environments, different-order polynomial interpolation algorithms are selected for segment path planning, so that under the condition of ensuring the operation precision of the mechanical arm, the operation efficiency of the algorithms is improved, the rigid impact at the joint of the mechanical arm is reduced, and the service life of the mechanical arm is prolonged.
Examples
The present embodiment is a path planning method for a seven-degree-of-freedom robot, as shown in fig. 1, where parameters of a mechanical arm DH of the present embodiment are shown in table 1:
TABLE 1D-H PARAMETERS
Wherein theta is a joint angle, d is the length of the connecting rod, α is the joint torsion, and a is the joint offset;
step 1-1, establishing a mathematical model of a mechanical arm in a three-dimensional space according to a robot standard D-H parameter, as shown in figure 1;
step 1-2, determining a starting point and a terminating point of the mechanical arm and a necessary middle path node in the motion process according to actual requirements, specifically expressed as:
the initial point is represented as (x)0,y0,z0) The middle point represents (x)1,y1,z1)...(xn-1,yn-1,zn-1) The end point is expressed as (x)n,yn,zn);
1-3, segmenting all points according to the characteristic requirements of an actual system on the mechanical arm, wherein the number of the segments is M, and M is taken as 3 in the embodiment; and take (x)0,y0,z0) To (x)1,y1,z1) Is the 1 st section; (x)1,y1,z1) To (x)3,y3,z3) Is the 2 nd paragraph; (x)3,y3,z3) To (x)4,y4,z4) Is paragraph 3;
step 1-4, reversely solving a joint angle value corresponding to the space point according to the space coordinate point, wherein the embodiment mainly considers a first joint and a second joint as follows:
q1=[0 2π 0 0 0 0],q2=[π/2 π/5 0 0 0 0],
q3=[π/3 π 0 0 0 0],q4=[π π/2 0 0 0 0],
q5=[π/5 π/4 0 0 0 0];
step 2-1, selecting different-order polynomial interpolation algorithm for different sections, and obtaining an angle qdThe polynomial with respect to time t can be expressed as:
in this embodiment, the requirement on the mechanical arm performance is high for the precision of the start section and the end section, and the requirement on the mechanical arm pulsation characteristic is high, a seventh-order polynomial is selected for planning, the requirement on the middle section is low, and a third-order polynomial is selected for planning, and the specific details are implemented as follows:
the selection rule is that the middle section selects low order, the two ends select high order, and the order selected at the two ends is the middle section order plus two:
establishing a cubic polynomial interpolation function, comprising: the function expressions of angular displacement and angular speed are respectively:
qd=a0+a1t+a2t2+a3t3
the constraints are as follows:
solving to obtain:
where t is time, a is a polynomial coefficient, q is a joint angle vector, t0And t1The start and end time points of the joint interpolation;
establishing a seventh order polynomial interpolation function, comprising: the functional expressions of angular displacement, angular velocity, angular acceleration, and pulsation characteristics (angular jerk) are respectively:
qd=a0+a1t+a2t2+a3t3+a4t4+a5t5+a6t6+a7t7
the constraints are as follows:
the following equation can be solved:
where t is time, a is a polynomial coefficient, q is a joint angle vector, t0And t1For the starting and ending time points of the joint interpolation, q0To be t0Substitution qdThe resulting polynomial, q, for t1To be t1Substitution qdResulting polynomial, v, about t0To be t0Substitution intoResulting multiple terms for tFormula (v)1To be t1Substitution intoThe resulting polynomial for t, a0To be t0Substitution intoThe resulting polynomial for t, a1To be t1Substitution intoThe resulting polynomial for t, j0To be t0Substitution intoThe resulting polynomial for t, j1To be t1Substitution intoThe obtained polynomial about t, and the time is set according to mechanical characteristics of the mechanical arm;
step 2-2, obtaining a time-varying rule graph of 3 sections of motion tracks according to the parameters and polynomial orders obtained in the step;
and 2-3, arranging and integrating the time-varying law graphs of the joint angular motion of each section according to the time sequence to generate a law graph of the joint angular motion of the sampling point in the whole track.
The invention adopts a piecewise polynomial interpolation algorithm to plan the path of the mechanical arm, divides the section composed of all path intermediate points into three sections, wherein the first section and the last section adopt seventh-order polynomial interpolation to plan the path points, the rest intermediate sections adopt fifth-order polynomial interpolation to plan the path points, and obtains the planning result of the joint angle of the joint changing along with time. The method has important significance for prolonging the service life of the mechanical arm.
Claims (5)
1. An industrial mechanical arm path planning method based on segmented multistage polynomial interpolation is characterized by comprising the following steps:
step 1, segmenting a starting point, an end point and a middle path node of a mechanical arm, and performing inverse solution on the starting point, the end point and the middle path node to obtain joint angle values corresponding to the starting point, the end point and the middle path node;
and 2, carrying out path planning on the sections obtained in the step 1 by using different-order polynomial interpolation functions to obtain different sections of planning curves, and arranging and integrating the different sections of planning curves according to the interval sequence to obtain a joint angular motion law diagram of the sampling points in the whole track.
2. The method for planning the path of the industrial mechanical arm based on the piecewise multi-order polynomial interpolation as claimed in claim 1, wherein the specific steps of the step 1 are as follows:
step 1-1, establishing a mathematical model of a mechanical arm in a three-dimensional space according to a standard D-H parameter of a robot;
step 1-2, determining space coordinate points of the mechanical arm, wherein the space coordinate points comprise a starting point, an end point and a necessary middle path node in the motion process;
1-3, segmenting all spatial coordinate points;
and 1-4, reversely solving a joint angle value corresponding to the space coordinate point according to the space coordinate point.
3. The method as claimed in claim 1, wherein the number of segments is 3 or 4.
4. The method as claimed in claim 1, wherein the order of the first and last segments of the polynomial order is higher than the order of the other segments.
5. The method for planning the path of the industrial mechanical arm based on the piecewise multi-order polynomial interpolation as claimed in claim 1, wherein the step 2 comprises the following steps:
step 2-1, selecting polynomial interpolation functions of different orders for different sections, and selecting the angle q of each sectiondThe polynomial formula with respect to time t is:
qd=a0+a1t+a2t2+...antn
order 2N +1 selected according to a polynomial, angle q for each segmentdPerforming a N-order derivation with respect to the polynomial expression at time t;
combining the constraint conditions:
solving the polynomial general formula parameter a0,a1,a2...an;
Step 2-2, describing the polynomial as a function of the angle with respect to time t according to the obtained parameters and the polynomial order to obtain a time-varying rule graph of the M-section motion trail;
and 2-3, arranging and integrating the time-varying law graphs of the joint angular motion of each section according to the time sequence to generate a law graph of the joint angular motion of the sampling point in the whole track.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911237104.3A CN111002308A (en) | 2019-12-05 | 2019-12-05 | Industrial mechanical arm path planning method based on segmented multistage polynomial interpolation |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911237104.3A CN111002308A (en) | 2019-12-05 | 2019-12-05 | Industrial mechanical arm path planning method based on segmented multistage polynomial interpolation |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111002308A true CN111002308A (en) | 2020-04-14 |
Family
ID=70114744
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911237104.3A Withdrawn CN111002308A (en) | 2019-12-05 | 2019-12-05 | Industrial mechanical arm path planning method based on segmented multistage polynomial interpolation |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111002308A (en) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112045397A (en) * | 2020-09-07 | 2020-12-08 | 中铁工程装备集团有限公司 | Steel arch splicing device and working method thereof |
CN112045685A (en) * | 2020-09-07 | 2020-12-08 | 中铁工程装备集团有限公司 | Multi-oil-cylinder cooperative control device and working method thereof |
CN113246143A (en) * | 2021-06-25 | 2021-08-13 | 视比特(长沙)机器人科技有限公司 | Mechanical arm dynamic obstacle avoidance trajectory planning method and device |
CN113843789A (en) * | 2021-08-13 | 2021-12-28 | 南京蓝昊智能科技有限公司 | Method for reducing rigid impact of mechanical arm |
CN113954081A (en) * | 2021-12-07 | 2022-01-21 | 中国煤炭科工集团太原研究院有限公司 | Working arm track planning method and system of anchor rod support robot |
CN114227695A (en) * | 2022-01-11 | 2022-03-25 | 中国煤炭科工集团太原研究院有限公司 | Anchor rod support robot working arm track planning method and system |
CN115781692A (en) * | 2023-01-09 | 2023-03-14 | 三一重型装备有限公司 | Mechanical arm path planning method and device, intelligent anchoring machine and storage medium |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103235513A (en) * | 2013-04-24 | 2013-08-07 | 武汉科技大学 | Genetic-algorithm-based trajectory planning optimization method for mobile mechanical arm |
CN105302147A (en) * | 2015-11-06 | 2016-02-03 | 太原科技大学 | Series connection mechanism locus planning method |
CN109343345A (en) * | 2018-09-28 | 2019-02-15 | 江南大学 | Mechanical arm polynomial interopolation method for planning track based on QPSO algorithm |
US20190278276A1 (en) * | 2018-03-09 | 2019-09-12 | Baidu Usa Llc | Emergency stop speed profile for autonomous vehicles |
CN110308699A (en) * | 2019-04-28 | 2019-10-08 | 威海印刷机械有限公司 | A kind of method for planning track |
-
2019
- 2019-12-05 CN CN201911237104.3A patent/CN111002308A/en not_active Withdrawn
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103235513A (en) * | 2013-04-24 | 2013-08-07 | 武汉科技大学 | Genetic-algorithm-based trajectory planning optimization method for mobile mechanical arm |
CN105302147A (en) * | 2015-11-06 | 2016-02-03 | 太原科技大学 | Series connection mechanism locus planning method |
US20190278276A1 (en) * | 2018-03-09 | 2019-09-12 | Baidu Usa Llc | Emergency stop speed profile for autonomous vehicles |
CN109343345A (en) * | 2018-09-28 | 2019-02-15 | 江南大学 | Mechanical arm polynomial interopolation method for planning track based on QPSO algorithm |
CN110308699A (en) * | 2019-04-28 | 2019-10-08 | 威海印刷机械有限公司 | A kind of method for planning track |
Non-Patent Citations (2)
Title |
---|
C.D.PORAWAGAMA等: "Reduced Jerk Joint Space Trajectory Planning Method Using 5-3-5 Spline for Robot Manipulators", 《7TH INTERNATIONAL CONFERENCE ON INFORMATION AND AUTOMATION FOR SUSTAINABILITY. IEEE》 * |
王亚洲: "多关节串联机器人的建模与运动控制", 《中国优秀博硕士学位论文全文数据库(硕士) 信息科技辑》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112045397A (en) * | 2020-09-07 | 2020-12-08 | 中铁工程装备集团有限公司 | Steel arch splicing device and working method thereof |
CN112045685A (en) * | 2020-09-07 | 2020-12-08 | 中铁工程装备集团有限公司 | Multi-oil-cylinder cooperative control device and working method thereof |
CN112045397B (en) * | 2020-09-07 | 2022-04-22 | 中铁工程装备集团有限公司 | Steel arch splicing device and working method thereof |
CN113246143A (en) * | 2021-06-25 | 2021-08-13 | 视比特(长沙)机器人科技有限公司 | Mechanical arm dynamic obstacle avoidance trajectory planning method and device |
CN113843789A (en) * | 2021-08-13 | 2021-12-28 | 南京蓝昊智能科技有限公司 | Method for reducing rigid impact of mechanical arm |
CN113954081A (en) * | 2021-12-07 | 2022-01-21 | 中国煤炭科工集团太原研究院有限公司 | Working arm track planning method and system of anchor rod support robot |
CN114227695A (en) * | 2022-01-11 | 2022-03-25 | 中国煤炭科工集团太原研究院有限公司 | Anchor rod support robot working arm track planning method and system |
CN114227695B (en) * | 2022-01-11 | 2023-09-08 | 中国煤炭科工集团太原研究院有限公司 | Anchor rod support robot working arm track planning method and system |
CN115781692A (en) * | 2023-01-09 | 2023-03-14 | 三一重型装备有限公司 | Mechanical arm path planning method and device, intelligent anchoring machine and storage medium |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111002308A (en) | Industrial mechanical arm path planning method based on segmented multistage polynomial interpolation | |
CN107390634B (en) | A kind of industrial robot track quintic algebra curve planing method | |
CN108621158B (en) | Time optimal trajectory planning control method and device for mechanical arm | |
CN111788040B (en) | Kinetic parameter identification method of robot, robot and storage device | |
CN107825424B (en) | Asymmetric S-shaped trajectory planning method for reducing residual vibration of high-speed manipulator | |
CN108205318A (en) | Method for planning track of robot and device | |
CN109648571A (en) | Teaching trajectory reproducing method, system and the robot of industrial robot | |
Shi et al. | Multi-objective optimal trajectory planning of manipulators based on quintic NURBS | |
CN114237161B (en) | Industrial robot NURBS curve interpolation method based on digital filtering | |
CN107436592A (en) | Accurate polishing orbit generation method based on B-spline | |
CN115256386B (en) | Uncertain mechanical arm neural self-adaptive control method considering tracking error constraint | |
WO2021041223A1 (en) | Motion planning for robots to optimize velocity while maintaining limits on acceleration and jerk | |
CN114211495A (en) | Self-adaptive track optimization method and system for semiconductor wafer conveying mechanical arm | |
CN108568823B (en) | Mechanical arm for numerical control machine tool capable of automatically processing workpiece and manufacturing method thereof | |
CN106707967A (en) | Method and device for estimating three-dimensional contour error based on proximate standard expansion | |
CN110703684B (en) | Trajectory planning method and device with unlimited endpoint speed | |
Bazaz et al. | Online computing of a robotic manipulator joint trajectory with velocity and acceleration constraints | |
Tangpattanakul et al. | Optimal trajectory of robot manipulator using harmony search algorithms | |
CN113442142B (en) | Smoothing method for Cartesian space motion trail of six-axis serial industrial robot | |
CN107290959B (en) | Robot Cartesian space velocity optimization method based on displacement equivalence | |
CN109278041B (en) | Transition error controllable mechanical arm linear track self-adaptive linking planning method | |
CN113485370A (en) | Parallel robot dynamic pick-and-place trajectory planning method and system | |
CN112706163B (en) | Mechanical arm motion control method, device, equipment and medium | |
CN112476436B (en) | Speed planning method and device for mechanical arm movement | |
CN109807893B (en) | Method for smoothing motion model of welding robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20200414 |
|
WW01 | Invention patent application withdrawn after publication |