一种自治水下运载器-绳驱动机械手轨迹规划方法

本发明公开了一种自治水下运载器‑绳驱动机械手轨迹规划方法，本发明涉及机械手轨迹规划技术领域，包括以下步骤：基于机械手几何结构，利用拉格朗日法构建刚体动力学框架，结合流体动力学仿真计算广义流体力，形成刚‑液耦合建模；采用Cosserat杆理论建立绳索柔性运动模型，与刚‑液耦合建模耦合，构建刚‑柔‑液耦合动力学模型，基于模型确定机械手的最大工作空间，定义虚拟工作空间作为轨迹规划的约束边界；通过五次样条插值生成平滑基础轨迹，分析不同路径点处受力情况，筛选符合条件的基础期望轨迹，并提取特征曲线参数；最终以优化函数选取最优轨迹，确保系统运动平稳、无冲击。