Vibration suppression method for stopping process section of industrial robot

Abstract

The invention discloses a vibration suppression method for a stopping process section of an industrial robot. From the perspective of a signal system, each joint end is directly planned, and a discrete Fourier transform amplitude range of a designed trajectory is taken as a objective function to enable a ratio of amplitude of main resonance frequency of each specific joint end in a planned deceleration section trajectory to be the smallest. Meanwhile, the objective function is made to meet the constraint conditions of ensuring the second-order continuity of the trajectory (c2) and ensuring themonotonicity of speed and the maximum acceleration amplitude limiting, finally, trajectory parameters are obtained by a method of convex optimization, and then the stop motion is completed by real-time interpolation. According to the vibration suppression method, an acceleration trajectory of each joint is directly optimized, so that the ratio of amplitude near a resonance point in a frequency domain is minimized, and then active vibration suppression is realized; and meanwhile, the method can reduce the delay caused by the inverse solution of calculation load, the time lag caused by shapingor notching is avoided, the preset stop time machine running distance is strictly guaranteed, and the safety of personnel and equipment is ensured.

Description

technical field [0001] The invention relates to a method for suppressing vibration of an industrial robot, in particular to a method for suppressing vibration of an industrial robot during the stop process. Background technique [0002] With the gradual accumulation of automation technology, the industrial robots launched by major manufacturers are not only rich in types, but also have increasingly perfect performance. Among them, regardless of safety considerations or process requirements, the stop mechanism of industrial robots will be one of the key indicators to measure the performance of robots. [0003] The robot quickly switches from the high-speed running state to the stopped state, such as the processing after collision detection or the triggering of the emergency stop button. threaten. [0004] For the vibration suppression of robots, from the perspective of control algorithms, fruitful results have been achieved, such as the Chinese invention patent document "A ...

AI Technical Summary

Problems solved by technology

However, for the stopping process with extremely strict time and distance requirements, it is usually only treated as a general working condition at present. The above method will inevitably cause time lag or delay from the end inverse solution to the joint end, etc.

Images