A seven-dimensional pose fusion trajectory smoothing interpolation method

By using a trajectory smoothing interpolation method based on seven-dimensional pose fusion, the problem of attitude continuity caused by the separation of position trajectory and attitude trajectory in robot trajectory planning is solved, and the synchronous smoothing of position trajectory and attitude trajectory is achieved, thereby improving the stability and accuracy of robot motion.

CN122408772APending Publication Date: 2026-07-17WUHAN INST OF TECH
View PDF 0 Cites 0 Cited by

Patent Information

Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
WUHAN INST OF TECH
Filing Date
2026-04-17
Publication Date
2026-07-17

AI Technical Summary

Technical Problem

In existing technologies, the separation of position trajectory and attitude trajectory in robot trajectory planning disrupts attitude continuity, affecting trajectory tracking accuracy and motion stability.

Method used

A trajectory smoothing interpolation method based on seven-dimensional pose fusion is adopted. By uniformly modeling discrete pose points, joint interpolation processing of three-dimensional position coordinates and quaternion pose components is performed. Cubic B-spline node vectors and seven-dimensional tangent boundary conditions are constructed. The seven-dimensional control vertices are solved using a tridiagonal linear equation system to generate continuous interpolated pose points.

Benefits of technology

It achieves synchronized and smooth position trajectory and attitude trajectory, reduces position and pose disconnection, avoids local attitude jumps, and improves the motion stability and operation accuracy of the end effector.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN122408772A_ABST
    Figure CN122408772A_ABST
Patent Text Reader

Abstract

本发明涉及轨迹规划与运动控制领域,公开了一种七维位姿融合的轨迹平滑插值方法;包括:本申请公开了一种七维位姿融合的轨迹平滑插值方法,涉及轨迹规划与运动控制技术领域。该方法包括:获取多个离散位姿点,每个离散位姿点包括三维位置坐标和四元数姿态分量;对四元数姿态分量进行单位化处理和相邻四元数同向性修正;分别计算相邻离散位姿点之间的位置距离和姿态距离,并进行归一化加权融合,得到综合距离;基于综合距离完成参数化并构造三次B样条节点矢量;根据端点工艺要求构建起始七维切矢和终止七维切矢;基于节点矢量、离散位姿点和七维切矢边界条件构建三对角线性方程组,求解七维控制顶点。
Need to check novelty before this filing date? Find Prior Art