CN113253677A - 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
CN113253677A
CN113253677A CN202110756998.8A CN202110756998A CN113253677A CN 113253677 A CN113253677 A CN 113253677A CN 202110756998 A CN202110756998 A CN 202110756998A CN 113253677 A CN113253677 A CN 113253677A
Authority
CN
China
Prior art keywords
track
speed
trajectory
parameter
optimization
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.)
Granted
Application number
CN202110756998.8A
Other languages
Chinese (zh)
Other versions
CN113253677B (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

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, and acquiring track start and end position and pose information and a speed threshold valueAcceleration threshold value and stored as track data with unified format
Figure 596951DEST_PATH_IMAGE001
In which the character
Figure 265830DEST_PATH_IMAGE002
Is shown as
Figure 321510DEST_PATH_IMAGE002
Bar instruction, character
Figure 75840DEST_PATH_IMAGE003
A threshold value is indicated which is indicative of,
Figure 812852DEST_PATH_IMAGE004
is shown as
Figure 398554DEST_PATH_IMAGE002
The pose information of the bar instructions is,
Figure 828398DEST_PATH_IMAGE005
is shown as
Figure 70024DEST_PATH_IMAGE002
The speed threshold required by the bar instruction,
Figure 908929DEST_PATH_IMAGE006
is shown as
Figure 552400DEST_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 887566DEST_PATH_IMAGE007
And parameters
Figure 678805DEST_PATH_IMAGE008
Representing the pose of the actual track, and performing initial smoothing at the inflection point to obtainTo a smoothed parameter trajectory
Figure 757619DEST_PATH_IMAGE009
Figure 317913DEST_PATH_IMAGE010
(1)
In the formula (1)
Figure 89560DEST_PATH_IMAGE011
Representing the smoothed parameter trajectory,
Figure 40199DEST_PATH_IMAGE012
for basis functions, selecting different basis functions may represent different curves,
Figure 985021DEST_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 337505DEST_PATH_IMAGE014
S3, speed parameter based
Figure 280053DEST_PATH_IMAGE015
Constraint of (2) to the parameter
Figure 281770DEST_PATH_IMAGE008
Speed planning is carried out to obtain a function of the parameter with respect to time, i.e.
Figure 702387DEST_PATH_IMAGE016
S4, comparing the parameter track obtained in the step S2
Figure 237273DEST_PATH_IMAGE009
Further smooth optimization is carried out, and smoothness and precision of the track are improved through optimization of the control points;
s5 error prediction of establishment mechanismMeasuring the model, based on the obtained parameter trajectory with velocity function
Figure 350723DEST_PATH_IMAGE017
Calculating a track error, and performing feedforward compensation by modifying a control point to obtain an optimized track with a speed function;
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 275953DEST_PATH_IMAGE018
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 562578DEST_PATH_IMAGE019
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 624075DEST_PATH_IMAGE019
Function of time
Figure 970743DEST_PATH_IMAGE020
Then, a function of the actual track with respect to time is obtained through calculation, and the speed planning method adopts trapezoidal speed planningThe method, the S-shaped speed planning method or the 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 383270DEST_PATH_IMAGE021
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 975050DEST_PATH_IMAGE001
In which the character
Figure 156633DEST_PATH_IMAGE002
Is shown as
Figure 408623DEST_PATH_IMAGE002
Bar instruction, character
Figure 308446DEST_PATH_IMAGE003
A threshold value is indicated which is indicative of,
Figure 874556DEST_PATH_IMAGE004
is shown as
Figure 238541DEST_PATH_IMAGE002
The pose information of the bar instructions is,
Figure 599115DEST_PATH_IMAGE005
is shown as
Figure 48551DEST_PATH_IMAGE002
The speed threshold required by the bar instruction,
Figure 418353DEST_PATH_IMAGE006
is shown as
Figure 872730DEST_PATH_IMAGE002
An acceleration threshold required by the bar command;
s2, passing the track data obtained in the step S1 through the control point
Figure 669785DEST_PATH_IMAGE022
And parameters
Figure 278621DEST_PATH_IMAGE019
Converted to a parametric trajectory and smoothed at the inflection point, as shown in fig. 2. The parameterized expression of the trajectory is as follows
Figure 514430DEST_PATH_IMAGE010
(1)
Wherein
Figure 525111DEST_PATH_IMAGE011
Representing the smoothed parameter trajectory,
Figure 555384DEST_PATH_IMAGE012
for basis functions, selecting different basis functions may represent different curves,
Figure 651516DEST_PATH_IMAGE013
to control the point, controlThe pose of the points affects the pose of the parameter trajectories. Here, the path points of the trajectory are selected as initial control points, i.e.
Figure 363120DEST_PATH_IMAGE014
(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 290625DEST_PATH_IMAGE019
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 429482DEST_PATH_IMAGE019
Function of time
Figure 576692DEST_PATH_IMAGE020
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 826408DEST_PATH_IMAGE023
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: parameter trajectory formula based on step S2
Figure 811681DEST_PATH_IMAGE023
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 are used to obtain the position of the actual trajectory point, 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 through the transfer function of the servo motion mechanism in step S2And (5) target track points.
As shown in figure 3 of the drawings,
Figure 183757DEST_PATH_IMAGE024
representing the original control point, and at the same time the target point of the original trajectory,
Figure 254481DEST_PATH_IMAGE025
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 based on the obtained parameter track with the speed function
Figure 370205DEST_PATH_IMAGE017
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 272302DEST_PATH_IMAGE018
Within the range of the accuracy requirement and the speed variation between discrete points
Figure 316743DEST_PATH_IMAGE026
Within the constraint range, obtaining the discrete track of the belt speed value
Figure 609184DEST_PATH_IMAGE027
S7, calculating the discrete track of the tape speed obtained in the step S6
Figure 528599DEST_PATH_IMAGE027
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 672608DEST_PATH_IMAGE001
In which the character
Figure 324169DEST_PATH_IMAGE002
Is shown as
Figure 369485DEST_PATH_IMAGE002
Bar instruction, character
Figure 827011DEST_PATH_IMAGE003
A threshold value is indicated which is indicative of,
Figure 375804DEST_PATH_IMAGE004
is shown as
Figure 463846DEST_PATH_IMAGE002
The pose information of the bar instructions is,
Figure 294661DEST_PATH_IMAGE005
is shown as
Figure 493561DEST_PATH_IMAGE002
The speed threshold required by the bar instruction,
Figure 896861DEST_PATH_IMAGE006
is shown as
Figure 218121DEST_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 972450DEST_PATH_IMAGE007
And parameters
Figure 709462DEST_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 295164DEST_PATH_IMAGE009
Figure 725008DEST_PATH_IMAGE010
(1)
In the formula (1)
Figure 701055DEST_PATH_IMAGE011
Representing the smoothed parameter trajectory,
Figure 304074DEST_PATH_IMAGE012
for the basis functions, different basis functions are selected to represent different curves,
Figure 947545DEST_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 846493DEST_PATH_IMAGE014
S3, speed parameter based
Figure 575415DEST_PATH_IMAGE015
Constraint of (2) to the parameter
Figure 654229DEST_PATH_IMAGE008
Speed planning is carried out to obtain a function of the parameter with respect to time, i.e.
Figure 214524DEST_PATH_IMAGE016
S4, comparing the parameter track obtained in the step S2
Figure 720591DEST_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 an error prediction model of the mechanism, based on the obtained belt speedParameter trajectory of degree function
Figure 936809DEST_PATH_IMAGE017
Calculating a track error, and performing feedforward compensation by modifying a control point to obtain an optimized track with a speed function;
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 881631DEST_PATH_IMAGE018
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 234115DEST_PATH_IMAGE019
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 238980DEST_PATH_IMAGE019
Function of time
Figure 240697DEST_PATH_IMAGE020
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 claimed in claim 1, characterized by: the optimization process of the control point in step S4 is as follows: parameter trajectory formula based on step S2
Figure 661314DEST_PATH_IMAGE021
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 true CN113253677A (en) 2021-08-13
CN113253677B 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)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113664839A (en) * 2021-10-25 2021-11-19 武汉瀚迈科技有限公司 Non-real-time and real-time mixed interpolation calculation method for industrial robot
CN113900413A (en) * 2021-11-24 2022-01-07 南京达风数控技术有限公司 Smooth speed control method of numerical control system
CN115122329A (en) * 2022-07-15 2022-09-30 武汉瀚迈科技有限公司 Convenient industrial robot joint space trajectory planning method
CN115202293A (en) * 2022-07-15 2022-10-18 武汉瀚迈科技有限公司 Two-section speed planning method for industrial robot
CN116048146A (en) * 2023-03-31 2023-05-02 中国船舶集团有限公司第七〇七研究所 Angular velocity smooth control method for inertial navigation of rotary fiber-optic gyroscope
CN116909154A (en) * 2023-09-13 2023-10-20 武汉瀚迈科技有限公司 Robot track optimization method for feedforward compensation through feature table lookup
CN117270381A (en) * 2023-11-06 2023-12-22 深圳市鸿栢科技实业有限公司 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
M. MAHDI GHAZAEI ARDAKAN: "Model Predictive Control for Real-Time Point-to-Point Trajectory Generation", 《IEEE》 *
李昌达: "工业机器人的运动轨迹规划和轨迹跟踪控制", 《中国优秀博硕士学位论文全文数据库(硕士)信息科技辑》 *

Cited By (11)

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

Also Published As

Publication number Publication date
CN113253677B (en) 2021-10-08

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
CN101804627B (en) Redundant manipulator motion planning method
CN100562823C (en) A kind of contour outline control method of complicated track
CN108568817B (en) Delta robot track connection control method based on Bezier curve
CN110450156B (en) Optimal design method of self-adaptive fuzzy controller of multi-degree-of-freedom mechanical arm system
US10824121B2 (en) Machine learning device, servo motor controller, servo motor control system, and machine learning method
Hladio et al. Path following for a class of mechanical systems
US20050033459A1 (en) Controller for machine
CN1824471A (en) Robot locus control method and apparatus and program of robot locus control method
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
JP2019164484A (en) Machine learning device, servo control device, servo control system and machine learning method
CN110948488B (en) Robot self-adaptive trajectory planning algorithm based on time optimization
JP2019125367A (en) Method for setting control parameter for model prediction control
CN111427308A (en) Error compensation comprehensive control method for trajectory planning of numerical control platform
CN110695994B (en) Finite time planning method for cooperative repetitive motion of double-arm manipulator
CN113311783A (en) S-shaped motion curve planning method and system
CN114211492A (en) Optimal trajectory planning method of multi-degree-of-freedom mechanical arm based on model
JPH0916241A (en) Method for setting acceleration/deceleration operation of robot
Luan et al. Optimum motion control of palletizing robots based on iterative learning
CN115202293B (en) Two-section type speed planning method for industrial robot
JP2014174842A (en) S-shaped acceleration/deceleration control program, operation control program, recording medium, controller, s-shaped acceleration/deceleration control calculation method, and work operation control system

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