Vision-based Pythagorean hodograph spline command generation and adaptive disturbance compensation for planar contour tracking

摘要

Many control problems encountered in industrial applications such as deburring, cutting, and polishing are required to simultaneously perform force control and contour following. If the mathematical model of the contour to be followed is known, then the control problem is straightforward, and many existing approaches can be used to tackle this problem. In contrast, if the mathematical model is not available, the control problem will become much more challenging. Among all possible solutions to circumvent the aforementioned difficulties, using a vision system to obtain the mathematical model of the contour to be followed is one of the best options. To this end, this paper proposes a vision-based approach, in which a vision system is employed to provide the exterior contour information of the object for machining. Subsequently, coordinate transformation between the image plane and the robot frame is performed. Based on the exterior contour information after coordinate transformation, a Pythagorean hodograph quintic spline interpolator based on S curve acceleration/deceleration is developed to generate motion commands. The fact that the arc length of a Pythagorean hodograph curve can be easily computed makes it particularly useful when performing motion planning for high-precision motion control systems. Moreover, in order to improve contour following accuracy, an integrated motion control structure consisting of an adaptive disturbance compensator, a sliding mode controller, and a friction compensator is also developed. Finally, several contour following experiments are conducted by a planar two-link robot manipulator to verify the effectiveness of the proposed approach.