人机末端交互运动中轨迹跟随控制算法

为了解决上肢康复机器人的灵活性低、体积笨重和康复效果差等问题,提出了使用协作机器人UR10作为一种新的康复辅助工具的控制算法。通过建立UR10的运动学模型和患者手臂运动学模型,确定患者手臂与UR10协作机器人末端交互运动的灵巧空间,获得机器人与患者合理的相对安放位置。在患者上肢手掌心能够到达的运动空间中,选定两条距离长度最远的空间轨迹,利用Robotics Toolbox对机器人末端沿代表性轨迹进行仿真,验证轨迹跟随控制的准确性。现场测试也验证了轨迹跟随和灵巧空间的有效性。