[发明专利]一种基于数据手套的水下机器人软体作业手位置跟踪方法

摘要

本发明针对数据手套的动态捕捉准确性和水下软体作业手位置跟踪的不准确性，公开了一种基于数据手套的水下机器人软体作业手位置跟踪方法。针对数据手套对人手部关节进行数据捕捉时角度不准确的问题，将姿态融合算法运用到数据手套的姿态采集中，融合三轴磁力计、三轴加速度计和三轴陀螺仪的数据求解出姿态角度。针对水下软体作业手对人手部位置跟踪的问题，本发明提出采用动态矩阵预测控制，通过设计轨迹跟踪误差性能优化指标，建立跟踪误差约束条件，并把满足约束条件的性能优化问题，转化为求解控制增量的二次规划问题，获得时域内满足误差约束条件的预测控制，提高了数据手套动态捕捉和水下软体作业手的位置跟踪的准确性。