一种绳驱超冗余蛇形机械臂关节控制方法、介质、设备

By establishing the DH coordinate system of the rope-driven super-redundant serpentine manipulator and constructing the mapping relationship between rope force and length, a parallel PID controller was designed to solve the problem of rope force control in the rope-driven super-redundant serpentine manipulator, improve control accuracy and system stability, and achieve effective control of rope force.

CN118927237BActive Publication Date: 2026-07-17CHINA UNIV OF GEOSCIENCES (WUHAN)

Patent Information

Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
CHINA UNIV OF GEOSCIENCES (WUHAN)
Filing Date
2024-07-22
Publication Date
2026-07-17

AI Technical Summary

Technical Problem

Existing technologies lack effective control over the rope force of rope-driven, ultra-redundant serpentine robotic arms, resulting in low control accuracy and poor system stability, making it unable to effectively cope with complex load changes and external disturbances.

Method used

A DH coordinate system for a rope-driven, super-redundant serpentine robotic arm is established, and a mapping relationship between rope force and length is constructed. A parallel PID controller is designed to perform closed-loop control of joint angles and rope force, including rope length and force control. Effective control of rope force is achieved through the combination of a rope force controller and a rope length controller.

Benefits of technology

It improves the control accuracy and system stability of the rope-driven super-redundant serpentine robotic arm, shortens the control time, increases the response rate, ensures that the rope force is within a reasonable range, and avoids rope slack or breakage.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118927237B_ABST
    Figure CN118927237B_ABST
Patent Text Reader

Abstract

本发明公开一种绳驱超冗余蛇形机械臂关节控制方法、介质、设备,涉及绳驱超冗余蛇形机械臂技术领域,方法包括:建立机械臂D‑H坐标系,计算相邻坐标系间的齐次变换矩阵;构建机械臂关节角度值与驱动空间绳索长度值的映射关系;构建绳驱机械臂的绳索力控制器,包括绳索长度控制部分和绳索力控制部分,绳索力控制部分输入为期望绳索力与实际绳索力的差,输出电机对绳索力控制的期望速度;绳索长度控制部分的输入为期望关节角和实际关节角的差,输出电机控制电缆长度所需的速度;期望速度和所需的速度之和为机械臂所需绳索速度,控制机械臂运动。本发明可以解决现有技术缺乏对绳驱超冗余蛇形机械臂的绳索力的有效控制问题。
Need to check novelty before this filing date? Find Prior Art