CN113253677B - Robot motion control method combining speed optimization and feedforward compensation - Google Patents

Robot motion control method combining speed optimization and feedforward compensation Download PDF

Info

Publication number
CN113253677B
CN113253677B CN202110756998.8A CN202110756998A CN113253677B CN 113253677 B CN113253677 B CN 113253677B CN 202110756998 A CN202110756998 A CN 202110756998A CN 113253677 B CN113253677 B CN 113253677B
Authority
CN
China
Prior art keywords
track
speed
trajectory
parameter
robot
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.)
Active
Application number
CN202110756998.8A
Other languages
Chinese (zh)
Other versions
CN113253677A (en
Inventor
马磊
颜昌亚
李振瀚
何姗姗
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuhan Hanmai Technology Co ltd
Original Assignee
Wuhan Hanmai Technology Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Wuhan Hanmai Technology Co ltd filed Critical Wuhan Hanmai Technology Co ltd
Priority to CN202110756998.8A priority Critical patent/CN113253677B/en
Publication of CN113253677A publication Critical patent/CN113253677A/en
Application granted granted Critical
Publication of CN113253677B publication Critical patent/CN113253677B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/414Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller
    • G05B19/4142Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller characterised by the use of a microprocessor
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/34Director, elements to supervisory
    • G05B2219/34013Servocontroller

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Hardware Design (AREA)
  • Microelectronics & Electronic Packaging (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

The invention aims to provide a robot motion control method combining speed optimization and feedforward compensation, which divides a robot motion control system into five modules: instruction analysis, preplanning, track optimization, track dispersion and real-time interpolation. The robot trajectory command is expressed into a parameter curve form, the pose of an actual trajectory is controlled by using a control point and a basis function of the parameter, then the parameter is subjected to speed planning, then smooth optimization and feedforward compensation are carried out by modifying the control point on the basis of the parameter trajectory of the existing speed function, finally trajectory dispersion is carried out according to the chord height difference and the speed variation, and the speed at the discrete point is optimized. The method improves and optimizes the traditional robot motion control system, thereby solving the technical problem of mutual influence of speed optimization and feedforward compensation in the prior art.

Description

Robot motion control method combining speed optimization and feedforward compensation
Technical Field
The invention belongs to the field of motion control of industrial robots, and particularly relates to a robot motion control method combining speed optimization and feedforward compensation.
Background
The robot motion control system is an important component of an industrial robot and determines the motion mode and the operation performance of the industrial robot. The complex and variable industrial application puts higher requirements on a motion control system of the industrial robot, on one hand, the robot end effector must move according to certain process requirements, and the requirements on an end pose point, speed and acceleration are required. On the other hand, the motion control system directly determines the motion mode, the operation precision and the service life of the industrial robot. Efficient production requirements force industrial robots to increase the speed and acceleration of motion, which also makes the problems of vibration and spatial errors of industrial robots more pronounced.
In industrial applications, articulated robots (also known as robotic arms) are most common and feature a long motion mechanism, mimicking the hand configuration of a human, containing multiple kinematic chains and long link arms in series, making industrial robots more susceptible to vibration and spatial errors. A good motion control system not only can promote industrial robot's operating accuracy and efficiency, can also guarantee good motion stability and reduce mechanical wear, and its key lies in two kinds of advanced control technique, firstly speed optimization, secondly servo error compensation.
The servo error compensation is mainly divided into two types, one is feedback compensation and the other is feedforward compensation. The feedback compensation is a method of compensating for a difference in comparison between feedback information of the servo motor and an input signal. The feedforward compensation is to predict the space error of the actual track according to the transfer function of the servo motion mechanism, and achieve the purpose of reducing the space error by modifying the theoretical track. The former compensation has hysteresis and cannot compensate the space error of the robot in time. The latter compensation has an advance property, and has a better effect of reducing the space error of the robot. Meanwhile, feedback compensation cannot be replaced by feedforward compensation, and the feedforward compensation is used for further improving the space precision of the robot on the basis of the feedback compensation.
A dilemma exists with conventional motion control systems in that servo feed forward compensation is performed after velocity optimization, but the results of the servo feed forward compensation can affect the results of the velocity optimization such that the velocity optimization is no longer an optimal solution. If the two sequences are switched, the result is worse, because the speed optimization changes the dynamic characteristics of the robot in operation, thereby causing the servo compensation to be completely ineffective.
The Chinese patent of the invention (CN 201510826995.1) proposes a robot control system track acceleration and deceleration interpolation algorithm, which adopts multi-spline interpolation as coarse interpolation and adopts a digital integration method and equal time interpolation to perform fine interpolation on a track, but the method only optimizes the motion speed in the motion control of a robot, does not consider servo errors and cannot completely ensure the real-time precision of the track. The invention provides a robot motion control method combining speed optimization and feedforward compensation, and simultaneously considers the continuity and the servo error of the motion speed, thereby effectively improving the motion precision and the smoothness of the robot track.
Disclosure of Invention
Aiming at the problems in the prior art, the invention provides a robot motion control method combining speed optimization and feedforward compensation, which divides a robot motion control system into five modules: instruction analysis, preplanning, track optimization, track dispersion and real-time interpolation. The method comprises the steps of firstly representing a robot track instruction in a parameter curve form, controlling the pose of an actual track by using a control point and a basis function of the parameter, then carrying out speed planning on the parameter, then carrying out smooth optimization and feedforward compensation by modifying the control point on the basis of the parameter track of the existing speed function, finally carrying out track dispersion according to a chord height difference and a speed variation, and optimizing the speed at a dispersion point.
The technical scheme adopted for solving the problems in the prior art is as follows:
a robot motion control method combining speed optimization and feedforward compensation is characterized by comprising the following steps:
s1, inputting a robot track instruction, analyzing the robot track instruction, acquiring track start and end point pose information, a speed threshold and an acceleration threshold, and storing the track start and end point pose information, the speed threshold and the acceleration threshold as track data in a unified format
Figure 813038DEST_PATH_IMAGE002
In which the character
Figure 569641DEST_PATH_IMAGE004
Is shown as
Figure 221202DEST_PATH_IMAGE004
Bar instruction, character
Figure 328836DEST_PATH_IMAGE006
A threshold value is indicated which is indicative of,
Figure 724045DEST_PATH_IMAGE008
is shown as
Figure 335155DEST_PATH_IMAGE004
The pose information of the bar instructions is,
Figure 423197DEST_PATH_IMAGE010
is shown as
Figure 690230DEST_PATH_IMAGE004
The speed threshold required by the bar instruction,
Figure 951447DEST_PATH_IMAGE012
is shown as
Figure 354747DEST_PATH_IMAGE004
An acceleration threshold required by the bar command; s2, performing initial smoothing on the robot track data obtained in the step S1, converting the original track into a parameter track form, and utilizing the control points
Figure 676006DEST_PATH_IMAGE014
And parameters
Figure 430336DEST_PATH_IMAGE016
Representing the pose of the actual track, and carrying out initial smoothing at the inflection point to obtain a smoothed parameter track
Figure 167348DEST_PATH_IMAGE018
Figure 755979DEST_PATH_IMAGE020
(1)
In the formula (1)
Figure 185824DEST_PATH_IMAGE022
Representing the smoothed parameter trajectory,
Figure 161870DEST_PATH_IMAGE024
for basis functions, selecting different basis functions may represent different curves,
Figure 764890DEST_PATH_IMAGE026
the pose of the control point directly affects the pose of the actual trajectory for the control point, where the path point of the trajectory is selected as the initial control point, i.e. the control point
Figure 408361DEST_PATH_IMAGE028
S3, speed parameter based
Figure 743527DEST_PATH_IMAGE030
Constraint of (2) to the parameter
Figure 534766DEST_PATH_IMAGE016
Speed planning is carried out to obtain a function of the parameter with respect to time, i.e.
Figure 613580DEST_PATH_IMAGE032
S4, comparing the parameter track obtained in the step S2
Figure 173874DEST_PATH_IMAGE018
Further smooth optimization is carried out, and smoothness and precision of the track are improved through optimization of the control points;
s5, establishing a robot servo error prediction model and establishing a robot servo error prediction model based on the obtained parameter track
Figure 679942DEST_PATH_IMAGE018
And function of parameter with respect to time
Figure 896160DEST_PATH_IMAGE032
Calculating the track error, and performing feedforward compensation by modifying the control point to obtainOptimizing the track;
s6, performing trajectory dispersion based on the chord height difference and the speed variation on the optimized trajectory obtained in the step S5, and ensuring the chord height difference between the dispersed trajectory and the trajectory obtained in the step S5
Figure 840982DEST_PATH_IMAGE034
Within the precision requirement range, the speed variation between discrete points is within the constraint range, and a discrete track with a speed value is obtained;
s7, carrying out speed optimization on the discrete track of the belt speed obtained in the step S6 at discrete points, so that the speed and the acceleration of the discrete track points have continuity;
and S8, carrying out real-time interpolation on the discrete track point data obtained in the step S7 to obtain servo motion commands, and sending the servo motion commands to servo drivers of all axes of the robot to realize the motion control of the robot.
In the step S2, formula (1) selects different basis functions to directly influence the continuity of the trajectory, and selects a third-order spline as the basis function to realize the G2 or G3 continuity of the actual trajectory.
The parameters are processed in the step S3
Figure 193466DEST_PATH_IMAGE036
The specific method for carrying out speed planning comprises the following steps: based on the parameter trajectory obtained in step S2, different speed planning methods are selected to obtain parameters
Figure 136014DEST_PATH_IMAGE036
Function of time
Figure 636266DEST_PATH_IMAGE032
And then, calculating to obtain a function of the actual track with respect to time, wherein the speed planning method adopts a trapezoidal speed planning method, an S-shaped speed planning method or a polynomial interpolation method and the like, and the motion speed of the actual track can be influenced by selecting different speed planning methods.
The optimization process of the control point in step S4 is as follows: parameter trajectory formula based on step S2
Figure 56883DEST_PATH_IMAGE038
The function of the actual trajectory with respect to time obtained in step S3 and the transfer function of the servo motion mechanism in the related art obtain the position of the actual trajectory point, calculate the offset vector between the actual trajectory point and the target trajectory point (i.e., the path point of the trajectory selected by the control point in step S2), and modify the position of the control point E in step S2 based on the offset vector until the actual trajectory passes through the target trajectory point.
The invention has the following advantages:
1. the invention overcomes the dilemma of mutual influence of speed optimization and feedforward compensation in the traditional robot motion control system, converts the speed planning of the robot track into the speed planning of parameters by using a parameter track method, converts the smooth optimization and the feedforward compensation of the robot track into the optimization compensation of control points, and skillfully avoids the mutual influence of the speed optimization and the feedforward compensation.
2. The motion control framework of the robot provided by the invention has a simple structure, is applicable to different types of robots, can be expanded by combining different speed planning methods, smooth optimization methods and feedforward compensation methods, and has strong universality.
Drawings
FIG. 1 is a general flow diagram of the process of the present invention;
FIG. 2 is a schematic diagram of smoothing of a parameterized trajectory;
FIG. 3 is a schematic diagram of smooth optimization of control points by a parameter trajectory;
fig. 4 is a schematic diagram of trajectory dispersion.
Detailed Description
In the following, the technical solution of the present invention is further described in detail by embodiments with reference to the accompanying drawings, as shown in fig. 1, the robot motion control framework of the present invention combining speed optimization and feedforward compensation mainly includes five modules: the method comprises the steps of instruction analysis, pre-planning, trajectory optimization, trajectory dispersion and real-time interpolation, wherein 1) the instruction analysis is to analyze and store trajectory instructions of the robot into robot trajectory data with a uniform format, so that a foundation is laid for calculation and optimization of subsequent modules, and the instruction analysis can be expanded according to robots of different brands, so that the method is suitable for robot motion control systems of different brands. 2) The pre-planning is to convert the original trajectory data into a parameter trajectory, perform initial smoothing at an inflection point, and perform speed planning on the parameter to obtain the parameter trajectory with an initial speed function. 3) The track optimization is to perform smooth optimization and feedforward compensation on control points of the parameter track on the basis of preplanning, keep the original basis function of the parameter track and the speed function of the parameter unchanged, and obtain the optimized track with the initial speed function. 4) And in the track dispersion, the optimized parameter track is subjected to track dispersion based on the chord height difference and the speed variation, the speed at a dispersion point is optimized, and finally the dispersion track with the speed is obtained. 5) And the final step of real-time interpolation is to convert the discrete track with the speed into a servo motion instruction and send the servo motion instruction to the servo drive of the robot so as to realize the motion control of the robot. The specific implementation steps are as follows:
s1, analyzing the track instruction of the industrial robot, acquiring the start and end position data, the speed threshold and the acceleration threshold of the track, and storing the data into the track data with a uniform format
Figure 529452DEST_PATH_IMAGE002
In which the character
Figure 439639DEST_PATH_IMAGE004
Is shown as
Figure 364870DEST_PATH_IMAGE004
Bar instruction, character
Figure 651495DEST_PATH_IMAGE006
A threshold value is indicated which is indicative of,
Figure 978571DEST_PATH_IMAGE008
is shown as
Figure 158247DEST_PATH_IMAGE004
The pose information of the bar instructions is,
Figure 570773DEST_PATH_IMAGE010
is shown as
Figure 395510DEST_PATH_IMAGE004
The speed threshold required by the bar instruction,
Figure 577093DEST_PATH_IMAGE012
is shown as
Figure 32345DEST_PATH_IMAGE004
An acceleration threshold required by the bar command;
s2, passing the track data obtained in the step S1 through the control point
Figure 994484DEST_PATH_IMAGE040
And parameters
Figure 560595DEST_PATH_IMAGE036
Converting into parameter track, and smoothing at inflection point to obtain smoothed parameter track
Figure 596684DEST_PATH_IMAGE041
As shown in fig. 2. The parameterized expression of the trajectory is as follows:
Figure 347471DEST_PATH_IMAGE020
(1)
wherein
Figure 734590DEST_PATH_IMAGE022
Representing the smoothed parameter trajectory,
Figure 901129DEST_PATH_IMAGE024
for basis functions, selecting different basis functions may represent different curves,
Figure 57304DEST_PATH_IMAGE026
the pose of the control point affects the pose of the parameter trajectory for the control point. Where the path of the trajectory is selectedThe point being an initial control point, i.e.
Figure 854359DEST_PATH_IMAGE028
(ii) a Different basis functions are selected to directly influence the continuity of the track, and a third-order spline curve can be selected as the basis function to realize the G2 or G3 continuity of the actual track.
S3, matching the parameters based on the step S2
Figure 525512DEST_PATH_IMAGE036
And (3) carrying out speed planning: based on the parameter trajectory obtained in step S2, different speed planning methods are selected to obtain parameters
Figure 699004DEST_PATH_IMAGE036
Function of time
Figure 709686DEST_PATH_IMAGE032
And then calculating to obtain the function of the actual track with respect to time. There are various speed planning methods, including trapezoidal speed planning, S-type speed planning, polynomial interpolation, etc., and selecting different speed planning methods may affect the motion speed of the actual trajectory.
S4, comparing the parameter track obtained in the step S2
Figure 739958DEST_PATH_IMAGE041
And further performing smooth optimization, and improving the smoothness and the precision of the track by optimizing the control points. The optimization process of the control point comprises the following steps: based on the parameter trajectory formula of step S2, the function of the actual trajectory with respect to time obtained in step S3 and the transfer function of the servomechanism in the prior art, the position of the actual trajectory point is obtained, the offset vector between the actual trajectory point and the target trajectory point (i.e., the path point of the trajectory selected by the control point in step S2) is calculated, and the position of the control point E in step S2 is modified based on the offset vector until the actual trajectory passes the target trajectory point.
As shown in figure 3 of the drawings,
Figure 836090DEST_PATH_IMAGE043
representing the original control point, and at the same time the target point of the original trajectory,
Figure 282115DEST_PATH_IMAGE045
the optimized control points are represented, and after the control points are smoothly optimized, the actual track is enabled to approximately pass through the original path points, so that the precision of the track is improved, and meanwhile, the smoothness of the parameter track is also improved.
S5, establishing a robot servo error prediction model and establishing a robot servo error prediction model based on the obtained parameter track
Figure 478129DEST_PATH_IMAGE041
And function of parameter with respect to time
Figure 616986DEST_PATH_IMAGE032
There are many methods for calculating the trajectory error and specifically establishing a robot servo error prediction model in the prior art, which are not described herein. And compensating the calculated track error to a control point of the parameter track, keeping the original parameter speed function unchanged, and obtaining the optimized track with the initial speed function.
S6, performing trajectory discretization based on chord height difference and speed variation on the optimized trajectory obtained in the step S5, as shown in FIG. 4, when performing trajectory discretization, it is necessary to ensure the chord height difference between the discretized polygonal line trajectory and the trajectory obtained in the step S5
Figure 200414DEST_PATH_IMAGE034
Within the range of the accuracy requirement and the speed variation between discrete points
Figure 512447DEST_PATH_IMAGE047
Within the constraint range, obtaining the discrete track of the belt speed value
Figure 497720DEST_PATH_IMAGE049
S7, calculating the discrete track of the tape speed obtained in the step S6
Figure 807479DEST_PATH_IMAGE049
Speed optimization is performed at discrete points.
And S8, carrying out real-time interpolation on the discrete track point data obtained in the step S7 to obtain servo motion commands, and sending the servo motion commands to servo drivers of all axes of the robot to realize the motion control of the robot.
The invention mainly solves the problem that the speed optimization and feedforward compensation in the traditional robot motion control system are mutually influenced, and has the core idea that the track of a robot is converted into a parameter track, the parameter track is expressed by a control point set and parameters, then the parameters are subjected to speed planning to obtain the parameter track with a speed function, then the feedforward optimization is carried out, the feedforward compensation is applied to an actual track by modifying the control point, the original speed function is not influenced, finally the track is dispersed, and the speed function at the discrete point is optimized, so that a track planning scheme which simultaneously meets the speed optimization and the feedforward compensation is obtained.
The protective scope of the present invention is not limited to the above-described embodiments, and it is apparent that various modifications and variations can be made to the present invention by those skilled in the art without departing from the scope and spirit of the present invention. It is intended that the present invention cover the modifications and variations of this invention provided they come within the scope of the appended claims and their equivalents.

Claims (4)

1. A robot motion control method combining speed optimization and feedforward compensation is characterized by comprising the following steps:
s1, inputting a robot track instruction, analyzing the robot track instruction, acquiring track start and end point pose information, a speed threshold and an acceleration threshold, and storing the track start and end point pose information, the speed threshold and the acceleration threshold as track data in a unified format
Figure DEST_PATH_IMAGE001
Wherein the character
Figure 166248DEST_PATH_IMAGE002
Is shown as
Figure 903260DEST_PATH_IMAGE002
Bar instruction, character
Figure DEST_PATH_IMAGE003
A threshold value is indicated which is indicative of,
Figure 488962DEST_PATH_IMAGE004
is shown as
Figure 981123DEST_PATH_IMAGE002
The pose information of the bar instructions is,
Figure DEST_PATH_IMAGE005
is shown as
Figure 285066DEST_PATH_IMAGE002
The speed threshold required by the bar instruction,
Figure 560189DEST_PATH_IMAGE006
is shown as
Figure 268907DEST_PATH_IMAGE002
An acceleration threshold required by the bar command;
s2, performing initial smoothing on the robot track data obtained in the step S1, converting the original track into a parameter track form, and utilizing the control points
Figure DEST_PATH_IMAGE007
And parameters
Figure 666390DEST_PATH_IMAGE008
Representing the pose of the actual track, and carrying out initial smoothing at the inflection point to obtain a smoothed parameter track
Figure DEST_PATH_IMAGE009
Figure 457629DEST_PATH_IMAGE010
(1)
In the formula (1)
Figure DEST_PATH_IMAGE011
Representing the smoothed parameter trajectory,
Figure 598760DEST_PATH_IMAGE012
for the basis functions, different basis functions are selected to represent different curves,
Figure DEST_PATH_IMAGE013
the pose of the control point directly affects the pose of the actual trajectory for the control point, where the path point of the trajectory is selected as the initial control point, i.e. the control point
Figure 159054DEST_PATH_IMAGE014
S3, speed parameter based
Figure DEST_PATH_IMAGE015
Constraint of (2) to the parameter
Figure 993018DEST_PATH_IMAGE008
Speed planning is carried out to obtain a function of the parameter with respect to time, i.e.
Figure 5973DEST_PATH_IMAGE016
S4, comparing the parameter track obtained in the step S2
Figure 888479DEST_PATH_IMAGE009
Further smooth optimization is carried out, and smoothness and precision of the track are improved through optimization of the control points;
s5, establishing a robot servo error prediction model and establishing a robot servo error prediction model based on the obtained parameter track
Figure 303280DEST_PATH_IMAGE009
And function of parameter with respect to time
Figure 245828DEST_PATH_IMAGE016
Calculating a track error, and performing feedforward compensation by modifying a control point to obtain an optimized track;
s6, performing trajectory dispersion based on the chord height difference and the speed variation on the optimized trajectory obtained in the step S5, and ensuring the chord height difference between the dispersed trajectory and the trajectory obtained in the step S5
Figure DEST_PATH_IMAGE017
Within the precision requirement range, the speed variation between discrete points is within the constraint range, and a discrete track with a speed value is obtained;
s7, carrying out speed optimization on the discrete track of the belt speed obtained in the step S6 at discrete points, so that the speed and the acceleration of the discrete track points have continuity;
and S8, carrying out real-time interpolation on the discrete track point data obtained in the step S7 to obtain servo motion commands, and sending the servo motion commands to servo drivers of all axes of the robot to realize the motion control of the robot.
2. A method of robot motion control with combined velocity optimization and feed forward compensation as claimed in claim 1, characterized by: formula (1) in step S2 selects a third-order spline as the basis function.
3. A method of robot motion control with combined velocity optimization and feed forward compensation as claimed in claim 1, characterized by: the parameters are processed in the step S3
Figure 743150DEST_PATH_IMAGE018
The specific method for carrying out speed planning comprises the following steps: based on the parameter trajectory obtained in step S2, different speed planning methods are selected to obtain parameters
Figure 226084DEST_PATH_IMAGE018
Function of time
Figure 698653DEST_PATH_IMAGE016
And then, calculating to obtain a function of the actual track with respect to time, wherein the speed planning method is a trapezoidal speed planning method, an S-shaped speed planning method or a polynomial interpolation method.
4. A method of robot motion control with combined velocity optimization and feed forward compensation as set forth in claim 3, characterized by: the optimization process of the control point in step S4 is as follows: parameter trajectory formula based on step S2
Figure DEST_PATH_IMAGE019
The function of the actual trajectory with respect to time and the transfer function of the servo motion mechanism obtained in step S3 obtain the position of the actual track point, calculate the offset vector between the actual trajectory point and the target track point, and modify the position of the control point E in step S2 based on the offset vector until the actual trajectory passes the target track point.
CN202110756998.8A 2021-07-05 2021-07-05 Robot motion control method combining speed optimization and feedforward compensation Active CN113253677B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110756998.8A CN113253677B (en) 2021-07-05 2021-07-05 Robot motion control method combining speed optimization and feedforward compensation

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110756998.8A CN113253677B (en) 2021-07-05 2021-07-05 Robot motion control method combining speed optimization and feedforward compensation

Publications (2)

Publication Number Publication Date
CN113253677A CN113253677A (en) 2021-08-13
CN113253677B true CN113253677B (en) 2021-10-08

Family

ID=77190585

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110756998.8A Active CN113253677B (en) 2021-07-05 2021-07-05 Robot motion control method combining speed optimization and feedforward compensation

Country Status (1)

Country Link
CN (1) CN113253677B (en)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113664839B (en) * 2021-10-25 2022-01-18 武汉瀚迈科技有限公司 Non-real-time and real-time mixed interpolation calculation method for industrial robot
CN113900413B (en) * 2021-11-24 2024-06-18 南京达风数控技术有限公司 Control method for smooth speed of numerical control system
CN115202293B (en) * 2022-07-15 2023-04-28 武汉瀚迈科技有限公司 Two-section type speed planning method for industrial robot
CN115122329B (en) * 2022-07-15 2022-12-30 武汉瀚迈科技有限公司 Convenient industrial robot joint space trajectory planning method
CN116048146B (en) * 2023-03-31 2023-06-13 中国船舶集团有限公司第七〇七研究所 Angular velocity smooth control method for inertial navigation of rotary fiber-optic gyroscope
CN116909154B (en) * 2023-09-13 2023-12-08 武汉瀚迈科技有限公司 Robot track optimization method for feedforward compensation through feature table lookup
CN117270381B (en) * 2023-11-06 2024-03-12 深圳市鸿栢科技实业有限公司 Industrial robot outer ring controller and control method

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011064816A1 (en) * 2009-11-26 2011-06-03 三菱電機株式会社 Numerical control device
JP2011186939A (en) * 2010-03-10 2011-09-22 Mitsubishi Electric Corp Numerical control device and production system
CN102681489A (en) * 2012-06-01 2012-09-19 南京航空航天大学 Control method for motion stability and outline machining precision of multi-shaft linkage numerical control system
CN104615084A (en) * 2015-01-23 2015-05-13 大连理工大学 Machining feed speed optimized tool path curve contour error compensation method
CN105785921A (en) * 2016-03-25 2016-07-20 华南理工大学 Speed planning method during NURBS curve interpolation of industrial robot
CN109623820A (en) * 2018-12-25 2019-04-16 哈工大机器人(合肥)国际创新研究院 A kind of robot space tracking transition method
JP2019063912A (en) * 2017-09-29 2019-04-25 キヤノン株式会社 Robot control data processing method, robot control data processing device and robot system
CN111427308A (en) * 2020-02-29 2020-07-17 华南理工大学 Error compensation comprehensive control method for trajectory planning of numerical control platform
CN112987568A (en) * 2021-02-09 2021-06-18 清华大学 Parallel processing robot feeding speed planning method and device

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2011064816A1 (en) * 2009-11-26 2011-06-03 三菱電機株式会社 Numerical control device
JP2011186939A (en) * 2010-03-10 2011-09-22 Mitsubishi Electric Corp Numerical control device and production system
CN102681489A (en) * 2012-06-01 2012-09-19 南京航空航天大学 Control method for motion stability and outline machining precision of multi-shaft linkage numerical control system
CN104615084A (en) * 2015-01-23 2015-05-13 大连理工大学 Machining feed speed optimized tool path curve contour error compensation method
CN105785921A (en) * 2016-03-25 2016-07-20 华南理工大学 Speed planning method during NURBS curve interpolation of industrial robot
JP2019063912A (en) * 2017-09-29 2019-04-25 キヤノン株式会社 Robot control data processing method, robot control data processing device and robot system
CN109623820A (en) * 2018-12-25 2019-04-16 哈工大机器人(合肥)国际创新研究院 A kind of robot space tracking transition method
CN111427308A (en) * 2020-02-29 2020-07-17 华南理工大学 Error compensation comprehensive control method for trajectory planning of numerical control platform
CN112987568A (en) * 2021-02-09 2021-06-18 清华大学 Parallel processing robot feeding speed planning method and device

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
Model Predictive Control for Real-Time Point-to-Point Trajectory Generation;M. Mahdi Ghazaei Ardakan;《IEEE》;20190430;第16卷(第2期);全文 *
工业机器人的运动轨迹规划和轨迹跟踪控制;李昌达;《中国优秀博硕士学位论文全文数据库(硕士)信息科技辑》;20190515(第05期);I140-411 *

Also Published As

Publication number Publication date
CN113253677A (en) 2021-08-13

Similar Documents

Publication Publication Date Title
CN113253677B (en) Robot motion control method combining speed optimization and feedforward compensation
CN109623810B (en) Method for planning smooth time optimal trajectory of robot
CN100562823C (en) A kind of contour outline control method of complicated track
CN109765887B (en) Automatic driving control method
US10824121B2 (en) Machine learning device, servo motor controller, servo motor control system, and machine learning method
CN101804627B (en) Redundant manipulator motion planning method
CN108568817B (en) Delta robot track connection control method based on Bezier curve
Hladio et al. Path following for a class of mechanical systems
US20050033459A1 (en) Controller for machine
CN112757306A (en) Inverse solution multi-solution selection and time optimal trajectory planning algorithm for mechanical arm
JP6748135B2 (en) Machine learning device, servo control device, servo control system, and machine learning method
JP2010511919A (en) Tolerance-based path design and control methods
TWI733738B (en) Proportional integral derivative control method and system incorporating multiple actuators
Jin et al. A fine-interpolation-based parametric interpolation method with a novel real-time look-ahead algorithm
Van Oosterwyck et al. Cad enabled trajectory optimization and accurate motion control for repetitive tasks
CN108098777B (en) Redundant manipulator moment layer repetitive motion control method
CN111033396A (en) Method for setting control parameters for model predictive control
CN115202293B (en) Two-section type speed planning method for industrial robot
CN111427308A (en) Error compensation comprehensive control method for trajectory planning of numerical control platform
CN110948488A (en) Robot self-adaptive trajectory planning algorithm based on time optimization
CN110695994B (en) Finite time planning method for cooperative repetitive motion of double-arm manipulator
He et al. Real-time time-optimal continuous multi-axis trajectory planning using the trajectory index coordination method
Luan et al. Optimum motion control of palletizing robots based on iterative learning
JPH0916241A (en) Method for setting acceleration/deceleration operation of robot
CN110989504A (en) Interval self-adaptive planning method for five-axis machining feed speed

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
GR01 Patent grant
GR01 Patent grant