Space circular arc interpolation method of triaxial cartesian robot

Abstract

The invention discloses a space circular arc interpolation method of a triaxial cartesian robot. The space circular arc interpolation method of the triaxial cartesian robot comprises the steps that any three non-collinear points on the movement path of the triaxial cartesian robot are designated; the three points are substituted into an analysis formula of the circle center and the radius; the central angle of the circular arc needing interpolation is calculated; the specific normal vector N of the plane where the three points are located is calculated, and a specific auxiliary vector M is constructed according to the normal vector N; the parameter equation of the interpolation points are expressed; the number of times of interpolation is calculated; the parameter value of the ith interpolation is calculated and substituted into the parameter equation, and the point coordinates of the ith interpolation are obtained; the termination point of interpolation is judged; and a calculation result is transmitted to an execution mechanism of the triaxial cartesian robot. The space circular interpolation method of the triaxial cartesian robot reduces the calculation amount, simplifies the code quantity, improves the operation speed and the interpolation precision, is suitable for any starting and termination points and any plane and can be applied to the robot control field having higherrequirements for the operation speed and the precision.

Description

technical field [0001] The invention belongs to the technical field of robot control, and in particular relates to a space circular interpolation method for a three-axis Cartesian coordinate robot. Background technique [0002] In today's applications in the field of robot control, such as dispensing and engraving of three-axis Cartesian robots, trajectory planning is the key to completing the task. Circular interpolation is one of the main tasks of trajectory planning. Usually, only a few key points on the motion path are given, and intermediate points are interpolated according to the characteristics of the trajectory, so as to achieve high-precision motion control in colleges and universities. These systems need to achieve real-time processing, and need a method with simple algorithm, low calculation amount, fast operation speed and high accuracy of interpolation coordinates. [0003] The existing technology needs to judge the interpolation direction, and the judgment me...

AI Technical Summary

Problems solved by technology

[0004] Existing techniques for judging the relationship between the center angle of a supplementary arc and the angle between two vectors include: separately calculating the angles from the starting point to the passing point, and from the passing point to the end point, and then summing them up. This requires three steps of calculation, and is not applicable to the passing points and The case where the angle between the starting point or the ending point exceeds π; judging by the mixed product, the calculation is complicated; or by inversely solving the parametric equation through the position, it is necessary to calculate the inverse trigonometric function

Images