The invention belongs to the field of
robot trajectory optimization, and particularly relates to a
trajectory optimization method and
system considering redundancy characteristics of a
robot macro-micro force control
grinding and
polishing system. The method comprises the following steps: S1, generating an initial
grinding and
polishing track based on a CAD model, and providing a discrete point curvature
estimation method to estimate the curvature of each path point; s2, on the basis of the curvature of the
discrete points, a mixed optimization target of a curve energy item and a curvature change rate about curvature square is constructed,
arc length and redundancy direction optimization constraints are considered, and an adjusted
grinding and
polishing track is generated through a nonlinear optimization method; s3, on the basis of the optimized initial points, an initial dominant point
selection method based on an angle-chord height-chord length joint criterion is adopted, and the trajectory precision is kept while the number of dominant points is reduced; and S4, on the basis of the optimized curved surface dominant points, an improved least square
iterative approximation method is provided to generate a parameterized B-spline grinding and polishing
path generation method, and final grinding and polishing track generation is achieved.