一种并联绳驱平衡控制系统
摘要:
本发明公开了一种并联绳驱平衡控制系统,包括:控制模块、第一驱动与传动模块、第二驱动与传动模块、绳索和力分析模块;平衡控制方法包括S1求解并联绳驱动平台的位姿矩阵;S2计算绳索与被控对象的连接点的自然坐标;S3计算绳索脱离滚筒切点坐标值,得到滑轮位置的表达式;S4得到2n个绳索与滑轮切点的表达式;S5得到n组力平衡方程;S6得到n组力矩平衡方程;S7构建最优化求解模型;S8求解n个绳索拉力和n个滑轮位置坐标值;S9求解绳索长度;S10求解电机转角。本发明解决了并联绳驱平台在任何位姿条件下无法保证平衡的问题,可实现精度更高、鲁棒性更强的运动控制。
0/0