关键词:
柔索并联机器人
运动学分析
动力学分析
运动仿真
前馈PID控制
摘要:
高龄化导致的脑卒中运动功能障碍患者需要借助于康复机构等进行辅助康复训练。设计一种辅助运动障碍患者从卧位到站立位基础姿态运动的四索驱并联机器人机构,利用电机驱动绞盘控制绳索伸长缩短辅助人体实现基础姿态的运动,绞盘缠绕处为钢丝绳,钢丝绳下端连接橡皮绳分别牵引在辅助人体运动的关键节点处。对机构进行运动学分析,求解索长与牵引点位置坐标的雅克比矩阵,并对绳索牵引人体达到坐立位、站立位运动过程人体运动角度及角速度进行预定规划。为了考虑橡皮绳弹性的动力学影响,基于拉格朗日动力学进行系统动力学建模,并利用Simulink开展动力学仿真,分析机构牵引人体运动过程中起卧角度、角速度及膝盖屈直角度、角速度的变化规律。在系统动力学模型基础上,应用非线性前馈补偿的PID控制方法对绳索收放长度进行控制,使绳索牵引人体安全、平缓地达到期望轨迹及期望速度,确保人体的舒适性,并利用Lyapunov方法证明控制系统的稳定性。针对有无重力补偿项、柔索变刚度和人体不同质量参数等因素对系统动力学影响进行了仿真,通过对比分析验证了弹性绳作为执行机构的必要性及控制律设计的有效性和稳定性。