[go: up one dir, main page]

CN107433589B - Robot vibration suppression method based on acceleration sensor - Google Patents

Robot vibration suppression method based on acceleration sensor Download PDF

Info

Publication number
CN107433589B
CN107433589B CN201710629036.XA CN201710629036A CN107433589B CN 107433589 B CN107433589 B CN 107433589B CN 201710629036 A CN201710629036 A CN 201710629036A CN 107433589 B CN107433589 B CN 107433589B
Authority
CN
China
Prior art keywords
robot
vibration
former
acceleration sensor
input
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
CN201710629036.XA
Other languages
Chinese (zh)
Other versions
CN107433589A (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.)
Rokae Shandong Intelligent Technology Co ltd
Original Assignee
Rokae Shandong Intelligent 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 Rokae Shandong Intelligent Technology Co ltd filed Critical Rokae Shandong Intelligent Technology Co ltd
Priority to CN201710629036.XA priority Critical patent/CN107433589B/en
Publication of CN107433589A publication Critical patent/CN107433589A/en
Application granted granted Critical
Publication of CN107433589B publication Critical patent/CN107433589B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

The invention provides a robot vibration suppression method based on an acceleration sensor, which comprises the following steps: performing a robot trajectory pre-run, comprising: mounting a three-axis acceleration sensor at the tail end of the robot, and acquiring vibration signals in three directions at a mounting position when the robot runs in advance; extracting vibration parameters of the industrial robot according to the acquired vibration signals; designing and inputting a former according to the obtained vibration parameters; and the input former is acted on the moving track of the industrial robot so as to correct the moving track of the industrial robot by the input former. The method for applying the input shaping to the industrial robot solves the problems that the input shaping parameters are difficult to obtain and the motion of each axis is not synchronous due to input shaping time lag, can inhibit the vibration of the industrial robot and improve the track and the positioning precision.

Description

Robot vibration suppression method based on acceleration sensor
Technical Field
The invention relates to the technical field of industrial robots, in particular to a robot vibration suppression method based on an acceleration sensor.
Background
Industrial robots play an increasingly important role in industrial fields. Due to the technical restriction, the joint speed reducing mechanism and the connecting rod of the industrial robot have different degrees of flexibility, and the flexibility is particularly obvious under the working condition of high speed and heavy load. Flexibility easily leads to vibration, and the existence of vibration not only can reduce robot trajectory tracking precision and positioning accuracy, but also can reduce the life of key spare part. The method has important economic benefit and practical value for inhibiting the vibration of the robot.
The vibration suppression of industrial robots is mostly developed from two layers, one is structural optimization and the other is control optimization. The structure optimization improves the structure resonance frequency by increasing the structure rigidity and reducing the structure quality, the rigidity of the connecting rod can be improved by topology optimization, the joint rigidity mainly depends on standard parts such as a speed reducer, a bearing, a synchronous belt and the like, and the lifting space is limited. The control optimization mainly comprises optimization planning and a control algorithm, wherein the optimization of the planning algorithm generally refers to the optimization of the motion track of the robot, and the excitation of flexible vibration of the robot can be avoided through high-order smooth and reasonable acceleration and deceleration parameters; the optimization of the control method is to select more reasonable feedback parameters and design more appropriate control rate to improve the vibration suppression effect. Compared with structure optimization, control optimization is easy to realize due to wide adaptability range, and more researches and applications are obtained.
The method is dependent on the mathematical model of the mechanical arm, is suitable for simple mechanical arms such as a flexible beam, but is difficult to apply to objects with very complex models such as industrial robots. The patent damping control robot system adopts an independent robot damping control device, the device receives action instructions sent by the robot control device and speed and acceleration feedback information collected by a sensor on the robot, iterative learning is carried out to obtain corrected action instructions, the method needs the independent damping control device, the cost is high, because an iterative learning mode is adopted, a plurality of iterations are needed to obtain more ideal correction values, and early debugging is troublesome. In addition to the above patents, many papers adopt an input shaping method to suppress residual vibration of a system, the method mainly applies convolution to joint instructions, simple input shaping may cause instruction time lag, and for a multi-joint industrial robot, joint instructions may not be synchronized, and although vibration may be suppressed, trajectory precision during operation may be reduced. In addition, the input molding technology is originated from a linear time-invariant system, and when the input molding technology is applied to a nonlinear or time-variant system, parameters are difficult to determine, while an industrial robot is a typical nonlinear time-variant system, and the application of the input molding technology to an actual industrial robot has certain difficulty.
Therefore, the conventional vibration suppression method for the industrial robot is somewhat insufficient and is difficult to be applied to an actual industrial robot.
Disclosure of Invention
The object of the present invention is to solve at least one of the technical drawbacks mentioned.
Therefore, the invention aims to provide a robot vibration suppression method based on an acceleration sensor.
In order to achieve the above object, an embodiment of the present invention provides a robot vibration suppression method based on an acceleration sensor, including the steps of:
step S1, executing a robot trajectory pre-run, including: mounting a three-axis acceleration sensor at the tail end of the robot, and acquiring vibration signals in three directions at a mounting position when the robot runs in advance;
step S2, extracting vibration parameters of the industrial robot according to the vibration signals collected in the step S1;
step S3, designing and inputting a former according to the vibration parameters obtained in the step S2;
and step S4, acting the input former on the operation track of the industrial robot so as to correct the operation track of the industrial robot by the input former.
Further, in the step S2, a vibration signal is collected according to the step S1, wherein the vibration signal is used for representing the vibration value of the accelerometer, the high-frequency signal and the low-frequency signal are removed through band-pass filtering, then the fourier transform FFT is used for extracting the first two orders of characteristic frequencies, and the damping ratio is obtained according to the multi-cycle amplitude attenuation, so as to obtain the vibration parameter of the industrial robot.
Further, in the step S3, the input former is:
Figure BDA0001363443850000021
the total time lag is T _ delay and the new total operating period is T-T _ delay.
Further, in the step S4,
the normalized arc length parameters of the track are set as follows:
Figure BDA0001363443850000022
wherein s belongs to [0,1], and the motion instruction is also parameterized as { x(s), y(s), z(s) };
coefficient of taking
Figure BDA0001363443850000031
Arc length parameter after runtime correction
sacc(τ)=sacc(kt)=s(t),t∈[0,T]
Assuming that the former is n-th order, the command after forming becomes
Figure BDA0001363443850000032
Wherein:
t'∈[0,T-tdelay]
Figure BDA0001363443850000033
Figure BDA0001363443850000034
according to the robot vibration suppression method based on the acceleration sensor, the method for applying the input shaping to the industrial robot solves the problems that the input shaping parameters are difficult to obtain and the motion of each axis is not synchronous due to the input shaping time lag, can suppress the vibration of the industrial robot, improves the track and the positioning precision, and has the following advantages:
(1) the vibration parameters are extracted according to the feedback information of the acceleration sensor without depending on an accurate object model, so that the realization difficulty is reduced, and the parameter accuracy is improved;
(2) vibration parameters are obtained through track pre-operation, operation is only needed once, and debugging efficiency is high;
(3) by correcting the track running time, the time lag caused by input molding is avoided, and the working efficiency of the robot is not influenced while the vibration is reduced;
(4) the input shaping is applied to the arc length parameter, not the joint space, so that the asynchrony of all the axes can be avoided, and the track precision is improved.
Additional aspects and advantages of the invention will be set forth in part in the description which follows and, in part, will be obvious from the description, or may be learned by practice of the invention.
Drawings
The above and/or additional aspects and advantages of the present invention will become apparent and readily appreciated from the following description of the embodiments, taken in conjunction with the accompanying drawings of which:
fig. 1 is a flow chart of a method for vibration suppression of a robot based on an acceleration sensor according to an embodiment of the present invention;
FIG. 2 is a flow chart of a method for vibration suppression of an acceleration sensor based robot according to another embodiment of the present invention;
FIG. 3 is a schematic diagram of a robot end mounted three-axis acceleration sensor in accordance with an embodiment of the present invention;
FIG. 4 is a graph illustrating the rate of change of the arc length parameter s (t) with time before, after, and after input shaping according to an embodiment of the present invention.
Detailed Description
Reference will now be made in detail to embodiments of the present invention, examples of which are illustrated in the accompanying drawings, wherein like or similar reference numerals refer to the same or similar elements or elements having the same or similar function throughout. The embodiments described below with reference to the drawings are illustrative and intended to be illustrative of the invention and are not to be construed as limiting the invention.
As shown in fig. 1 and 2, the method for suppressing vibration of a robot based on an acceleration sensor according to an embodiment of the present invention includes the following steps:
step S1, executing a robot trajectory pre-run, including: a three-axis acceleration sensor is arranged at the tail end of the robot, and vibration signals in three directions at the mounting position of the robot in the pre-operation process are collected.
Specifically, most industrial robots generate a movement path in a teaching manner, and for example, cartesian space movement is represented as { x (T), y (T), z (T) }, where T ∈ [0, T ] is a movement time. The robot moves according to an unmodified teaching track, and due to the existence of structural flexibility, vibration is easily excited when the track starts and stops. According to the invention, a three-axis acceleration sensor (shown in figure 3) is arranged at the tail end of the robot, and vibration signals in three directions at the installation position of the robot during the pre-operation are collected. The pre-operation can also acquire the actual operation total time T of the robot.
And step S2, extracting vibration parameters of the industrial robot according to the vibration signals collected in the step S1.
Specifically, according to step S1, a vibration signal is collected by pre-running, wherein the vibration signal is used for representing the vibration value of the accelerometer, the high-frequency and low-frequency signals are removed by band-pass filtering, then fourier transform FFT is used for extracting the first two orders of characteristic frequencies, and the damping ratio is obtained according to multi-cycle amplitude attenuation, so as to obtain the vibration parameter of the industrial robot.
The vibration parameters required for input shaping include vibration frequency and damping. The frequency is related to rigidity and inertia, changes greatly along with loads and robot configurations, and the first-order frequency needing to be concerned in vibration suppression is usually in the range of 3Hz to 15 Hz; the damping variation is relatively small and the input shaping is much less sensitive to damping errors than frequency errors. The industrial robot is a complex multi-body system, joints and connecting rods have flexibility of different degrees, the modeling difficulty of such a complex object is high, and even if an accurate model exists, accurate model parameters are difficult to obtain. According to the method, the frequency and the rigidity are not extracted according to an object model, but according to the accelerometer vibration value acquired in the previous step in advance, high-frequency and low-frequency signals are removed through band-pass filtering, then the first two-order characteristic frequency is extracted through FFT, and the damping ratio is obtained according to a plurality of periodic amplitude attenuations.
And step S3, designing and inputting the former according to the vibration parameters obtained in the step S2.
In one embodiment of the invention, the input former is:
Figure BDA0001363443850000051
total time lag ofT _ delay, the new total operating period is T-T _ delay.
Specifically, with the vibration parameters, an input former can be designed according to the vibration parameters, and the method has no special requirements on the former, and the input former is assumed to be
Figure BDA0001363443850000052
The total time lag is T _ delay and the new total operating period is T-T _ delay.
And step S4, applying the input former on the operation track of the industrial robot so as to correct the operation track of the industrial robot by the input former.
In particular, if the former acts on the joint space, it causes the axes to be out of synchronism, resulting in a trajectory deviation. The patent applies the input former to a normalized arc length of the trajectory,
the normalized arc length parameters of the trace are:
Figure BDA0001363443850000053
thus s ∈ [0,1], the motion command is also parameterized as { x(s), y(s), z(s) };
coefficient of taking
Figure BDA0001363443850000054
Arc length parameter after runtime correction
sacc(τ)=sacc(kt)=s(t),t∈[0,T]
Assuming that the former is n-th order, the command after forming becomes
Figure BDA0001363443850000055
Wherein:
t'∈[0,T-tdelay]
Figure BDA0001363443850000056
Figure BDA0001363443850000057
figure 4 shows the rate of change of the arc length parameter s (t) with time before, after and after temporal modification.
The robot can effectively inhibit the vibration when starting and stopping according to the movement of the corrected arc length parameter.
In the invention, on the aspect of obtaining the vibration parameters, the vibration parameters are obtained through track pre-operation at one time, the parameters are collected through an acceleration sensor and come from actual operation, the precision is ensured, and the difficulty in obtaining the parameters is reduced. In the input molding implementation mode, particularly, the input molding is applied to the arc length parameter instead of the joint space, so that the reduction of the track precision caused by the asynchronous of all the axes is avoided.
According to the robot vibration suppression method based on the acceleration sensor, the method for applying the input shaping to the industrial robot solves the problems that the input shaping parameters are difficult to obtain and the motion of each axis is not synchronous due to the input shaping time lag, can suppress the vibration of the industrial robot, improves the track and the positioning precision, and has the following advantages:
(1) the vibration parameters are extracted according to the feedback information of the acceleration sensor without depending on an accurate object model, so that the realization difficulty is reduced, and the parameter accuracy is improved;
(2) vibration parameters are obtained through track pre-operation, operation is only needed once, and debugging efficiency is high;
(3) by correcting the track running time, the time lag caused by input molding is avoided, and the working efficiency of the robot is not influenced while the vibration is reduced;
(4) the input shaping is applied to the arc length parameter, not the joint space, so that the asynchrony of all the axes can be avoided, and the track precision is improved.
In the description herein, references to the description of the term "one embodiment," "some embodiments," "an example," "a specific example," or "some examples," etc., mean that a particular feature, structure, material, or characteristic described in connection with the embodiment or example is included in at least one embodiment or example of the invention. In this specification, the schematic representations of the terms used above do not necessarily refer to the same embodiment or example. Furthermore, the particular features, structures, materials, or characteristics described may be combined in any suitable manner in any one or more embodiments or examples.
Although embodiments of the present invention have been shown and described above, it is understood that the above embodiments are exemplary and should not be construed as limiting the present invention, and that variations, modifications, substitutions and alterations can be made in the above embodiments by those of ordinary skill in the art without departing from the principle and spirit of the present invention. The scope of the invention is defined by the appended claims and equivalents thereof.

Claims (2)

1. A robot vibration suppression method based on an acceleration sensor is characterized by comprising the following steps:
step S1, executing a robot trajectory pre-run, including: mounting a three-axis acceleration sensor at the tail end of the robot, and acquiring vibration signals in three directions at a mounting position when the robot runs in advance;
step S2, extracting vibration parameters of the robot according to the vibration signals collected in the step S1;
step S3, designing and inputting a former according to the vibration parameters obtained in the step S2; wherein the input former is:
Figure FDA0002692305300000011
the total time lag is T _ delay, and the new total operation period is T-T _ delay;
wherein Ai is the amplitude of the ith order of the former, t is a time variable, ti is the delay of the ith order of the former, and delta is a pulse function;
step S4, acting the input former on the running track of the robot so as to correct the running track of the robot by using the input former;
the normalized arc length parameters of the track are set as follows:
Figure FDA0002692305300000012
wherein s belongs to [0,1], and the motion instruction is also parameterized as { x(s), y(s), z(s) };
coefficient of taking
Figure FDA0002692305300000013
Defining a new variable tau-kt, correcting the running time by taking the variable tau as a parameter,
Figure FDA0002692305300000014
as a correction amount on the x-axis,
Figure FDA0002692305300000015
correction on the y-axis;
Figure FDA0002692305300000016
is the correction in the z-axis;
arc length parameter after runtime correction
sacc(τ)=sacc(kt)=s(t),t∈[0,T]
Assuming that the former is n-th order, the command after forming becomes
Figure FDA0002692305300000021
Wherein:
t'∈[0,T-tdelay]
Figure FDA0002692305300000022
Figure FDA0002692305300000023
2. the method for suppressing vibration of an acceleration sensor based robot according to claim 1, wherein in the step S2, the vibration signal collected according to the step S1 is pre-run, wherein the vibration signal is used to represent the vibration value of the accelerometer, the high frequency and low frequency signals are removed by band pass filtering, then the fourier transform FFT is used to extract the first two orders of characteristic frequency, and the damping ratio is obtained according to the multi-cycle amplitude attenuation, so as to obtain the vibration parameter of the robot.
CN201710629036.XA 2017-07-28 2017-07-28 Robot vibration suppression method based on acceleration sensor Active CN107433589B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710629036.XA CN107433589B (en) 2017-07-28 2017-07-28 Robot vibration suppression method based on acceleration sensor

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710629036.XA CN107433589B (en) 2017-07-28 2017-07-28 Robot vibration suppression method based on acceleration sensor

Publications (2)

Publication Number Publication Date
CN107433589A CN107433589A (en) 2017-12-05
CN107433589B true CN107433589B (en) 2021-03-23

Family

ID=60459784

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710629036.XA Active CN107433589B (en) 2017-07-28 2017-07-28 Robot vibration suppression method based on acceleration sensor

Country Status (1)

Country Link
CN (1) CN107433589B (en)

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108227498B (en) * 2018-01-12 2020-08-07 中国矿业大学 A method for forced stabilization of torsional vibration of permanent magnet direct drive shaft system
CN108267959B (en) * 2018-01-31 2021-06-08 珞石(北京)科技有限公司 Method for jointly inhibiting vibration based on iterative learning control and input shaping technology
CN108303887A (en) * 2018-01-31 2018-07-20 珞石(北京)科技有限公司 A method of the inhibition actual robot system vibration based on EI reshapers
CN108638056A (en) * 2018-04-13 2018-10-12 华南理工大学 Joint of robot vibration analysis based on kinetics of deformable bodies model and suppressing method
JP6836544B2 (en) * 2018-05-09 2021-03-03 ファナック株式会社 Control system and driven body control method
CN109799701B (en) * 2018-12-29 2022-04-29 南京埃斯顿机器人工程有限公司 Industrial robot vibration suppression method
CN110103220B (en) * 2019-05-20 2021-11-26 华南理工大学 High-speed and high-precision robot motion trajectory planning method, device, equipment and medium
US20220134552A1 (en) * 2019-06-25 2022-05-05 Disney Enterprises, Inc. Vibration suppression and dynamic balancing for retargeting motions onto robotic systems
US11478931B2 (en) * 2019-06-25 2022-10-25 Disney Enterprises, Inc. Computational vibration suppression for robotic systems
CN110370278B (en) * 2019-07-16 2020-11-13 绍兴文理学院 A route adjustment system and method based on industrial robot jitter analysis
CN110480659B (en) * 2019-08-26 2022-12-16 华南理工大学 A vibration control device and method when a robot manipulates the movement of a flexible workpiece
CN113031530B (en) * 2019-12-09 2022-06-10 合肥欣奕华智能机器股份有限公司 Robot control method, robot control device and robot
CN111347425B (en) * 2020-03-04 2021-08-10 深圳易能电气技术股份有限公司 Mechanical vibration suppression method, system and computer readable storage medium
CN114055515B (en) * 2020-07-31 2023-07-07 配天机器人技术有限公司 Jitter analysis method and system
CN114619483A (en) * 2020-12-08 2022-06-14 山东新松工业软件研究院股份有限公司 Flexible robot vibration suppression method and system based on trajectory correction
CN114505844B (en) * 2022-01-24 2023-06-20 华南理工大学 A residual vibration suppression system and method for industrial robots

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6002232A (en) * 1997-08-15 1999-12-14 Iowa State University Research Foundation, Inc. Robust vibration suppression methods and systems
JP2006003953A (en) * 2004-06-15 2006-01-05 Yaskawa Electric Corp Mechanical vibration suppressing device and mechanical vibration frequency detecting method
US8886359B2 (en) * 2011-05-17 2014-11-11 Fanuc Corporation Robot and spot welding robot with learning control function
CN102501242B (en) * 2011-09-28 2014-10-08 华南理工大学 Three-degree-of-freedom flexible manipulator control device and method
CN102636993A (en) * 2012-04-19 2012-08-15 徐州工程学院 Method for restraining flexible arm tail end vibration of robot
JP5438175B2 (en) * 2012-07-09 2014-03-12 ファナック株式会社 Vibration control robot system

Also Published As

Publication number Publication date
CN107433589A (en) 2017-12-05

Similar Documents

Publication Publication Date Title
CN107433589B (en) Robot vibration suppression method based on acceleration sensor
Hu et al. Deep GRU neural network prediction and feedforward compensation for precision multiaxis motion control systems
Mohamed et al. Command shaping techniques for vibration control of a flexible robot manipulator
Pereira et al. Integral resonant control for vibration damping and precise tip-positioning of a single-link flexible manipulator
CN108714896A (en) A kind of robot flexibility torque feed forward control method based on kinetics of deformable bodies model
KR20200031081A (en) Vibration control of configuration-dependent dynamic systems
Jianyong et al. Adaptive nonlinear optimal compensation control for electro-hydraulic load simulator
CN107160396B (en) A kind of robot vibration controller and method based on track optimizing
CN114310907A (en) Multi-working-condition self-adaptive industrial robot tail end vibration suppression method
CN108267959B (en) Method for jointly inhibiting vibration based on iterative learning control and input shaping technology
CN111673742A (en) Industrial robot trajectory tracking control algorithm
US12343870B1 (en) Self-adaptive identification method for nonlinear dynamic parameters of reducer
CN115473467B (en) Command filtering backstepping control method for flexible joint manipulator based on fuzzy observer
Suzumura et al. A general framework for designing SISO-based motion controller with multiple sensor feedback
Shang et al. Speed control strategy of dual flexible servo system considering time‐varying parameters for flexible manipulator with an axially translating arm
Zhang et al. A joint acceleration estimation method based on a high-order disturbance observer
CN106125551B (en) Integral Sliding Mode repetitive controller suitable for period servo-system
CN111015661B (en) Active vibration control method and system for flexible load of robot
Zhang et al. Bioinspired reference model and fully actuated system approach-based neuroadaptive control for uncertain active suspension systems with input dead zones
CN103413049B (en) Based on the acquisition methods of the axial parallel machine tool structure Optimal Parameters value of electromechanical coupling characteristics
Cole et al. Convolution-based input shaping for finite-time settling in non-LTI systems: An LTV approach
Chen et al. Iterative learning control with sensor fusion for robots with mismatched dynamics and mismatched sensing
CN113325703A (en) Active disturbance rejection controller for inhibiting resonance and design method thereof
CN115202292B (en) A command correction method considering frequency domain characteristics of servo control system
Luo et al. Rejecting multi-stage and low-frequency resonance with disturbance observer and feedforward control for engine servo

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