发明公开
- 专利标题: 一种并联绳驱平衡控制系统
-
申请号: CN202310696144.4申请日: 2023-06-12
-
公开(公告)号: CN116968057A公开(公告)日: 2023-10-31
- 发明人: 贾龙飞 , 李浩 , 于志远 , 杨玉凯 , 杨帆 , 张俊宁
- 申请人: 北京精密机电控制设备研究所
- 申请人地址: 北京市丰台区南大红门路1号
- 专利权人: 北京精密机电控制设备研究所
- 当前专利权人: 北京精密机电控制设备研究所
- 当前专利权人地址: 北京市丰台区南大红门路1号
- 代理机构: 中国航天科技专利中心
- 代理商 范晓毅
- 主分类号: B25J13/00
- IPC分类号: B25J13/00 ; B25J9/10 ; B25J9/16
摘要:
本发明公开了一种并联绳驱平衡控制系统,包括:控制模块、第一驱动与传动模块、第二驱动与传动模块、绳索和力分析模块;平衡控制方法包括S1求解并联绳驱动平台的位姿矩阵;S2计算绳索与被控对象的连接点的自然坐标;S3计算绳索脱离滚筒切点坐标值,得到滑轮位置的表达式;S4得到2n个绳索与滑轮切点的表达式;S5得到n组力平衡方程;S6得到n组力矩平衡方程;S7构建最优化求解模型;S8求解n个绳索拉力和n个滑轮位置坐标值;S9求解绳索长度;S10求解电机转角。本发明解决了并联绳驱平台在任何位姿条件下无法保证平衡的问题,可实现精度更高、鲁棒性更强的运动控制。