买专利卖专利找龙图腾,真高效! 查专利查商标用IPTOP,全免费!专利年费监控用IP管家,真方便!
申请/专利权人:中国地质大学(武汉)
摘要:本发明公开一种绳驱超冗余蛇形机械臂关节控制方法、介质、设备,涉及绳驱超冗余蛇形机械臂技术领域,方法包括:建立机械臂D‑H坐标系,计算相邻坐标系间的齐次变换矩阵;构建机械臂关节角度值与驱动空间绳索长度值的映射关系;构建绳驱机械臂的绳索力控制器,包括绳索长度控制部分和绳索力控制部分,绳索力控制部分输入为期望绳索力与实际绳索力的差,输出电机对绳索力控制的期望速度;绳索长度控制部分的输入为期望关节角和实际关节角的差,输出电机控制电缆长度所需的速度;期望速度和所需的速度之和为机械臂所需绳索速度,控制机械臂运动。本发明可以解决现有技术缺乏对绳驱超冗余蛇形机械臂的绳索力的有效控制问题。
主权项:1.一种绳驱超冗余蛇形机械臂关节控制方法,其特征在于,包括以下步骤:S1、建立绳驱超冗余蛇形机械臂D-H坐标系,计算D-H坐标系的相邻坐标系间的齐次变换矩阵;S2、基于D-H坐标系的相邻坐标系间的齐次变换矩阵,构建绳驱超冗余蛇形机械臂关节角度值与驱动空间绳索长度值的映射关系;S3、根据绳驱超冗余蛇形机械臂关节角度值与驱动空间绳索长度值的映射关系,构建绳驱机械臂的绳索力控制器,控制器包括绳索长度控制部分和绳索力控制部分,绳索力控制部分输入为期望绳索力与机械臂反馈的实际绳索力的差,输出驱动电机对绳索力控制的期望速度;绳索长度控制部分的输入为期望关节角和机械臂反馈的实际关节角的差,输出驱动电机控制电缆长度所需的速度;驱动电机对绳索力控制的期望速度和驱动电机控制电缆长度所需的速度之和为机械臂所需绳索速度;S4、根据绳驱机械臂的绳索力控制器,控制机械臂运动。
全文数据:
权利要求:
百度查询: 中国地质大学(武汉) 一种绳驱超冗余蛇形机械臂关节控制方法、介质、设备
免责声明
1、本报告根据公开、合法渠道获得相关数据和信息,力求客观、公正,但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解,仅供参考使用,不能作为本公司承担任何法律责任的依据或者凭证。