摘要
本发明提供一种上肢姿态计算方法及系统,方法包括根据肘关节坐标以及肘关节距离计算肩关节坐标,并得到上肢姿态数据;将肩关节坐标、肘关节坐标、末端中心点坐标存储为数据组,对数据组进行处理以得到第一数据组;判断新获取的肘关节坐标是否在第一数据组,若否,将新获取的肘关节坐标存储至第二数据组中;求取第一数据组中所有肩关节点位置的第一平均值,并将第一平均值作为肩关节中心点;求取第二数据组中所有肩关节点位置的第二平均值,比对第二平均值与肩关节中心点,若第二平均值与肩关节中心点的偏差大于预设值,更新肩关节中心点。本发明能够判断肩关节中心是否发生偏移,并更新肩关节中心点,从而能够准确的确认肩关节中心点位置。
技术关键词
肘关节
肩关节
姿态计算方法
上肢康复机器人
小臂
数据
姿态传感器
运动
偏差
坐标点
表达式
大臂
人体
存储模块
轨迹
曲线