APP下载

基于四元数互补滤波算法的前臂假肢手部自平衡系统设计

2018-03-08王传江王栋侯鹏亮袁振张远来

机器人技术与应用 2018年1期

王传江 王栋 侯鹏亮 袁振 张远来

(1山东科技大学机器人研究中心,山东青岛,266590; 2山东省机器人与智能技术重点实验室,山东青岛,266590;3山东大学控制科学与工程学院,济南,250061)

0 引言

目前,市场上大部分前臂假肢多为装饰假肢,仅仅起到美观、装饰的作用,并不能真正实现其代偿功能。为了满足前臂截肢者端水等基本日常生活需要,本文设计了一种两自由度电动前臂假肢手部自平衡系统,通过控制前臂旋转和手腕俯仰,使得患者前臂假肢在运动过程中其假肢末端手部虎口处始终与水平面保持平行。

前臂假肢手部自平衡系统主要包括姿态解算和手臂控制两部分,由于人类在运动时所做动作的复杂性和不确定性,因此要使假肢手部能够在运动时始终保持平衡,姿态解算则是实现该系统自平衡的关键问题之一。

姿态解算的速度和精度会直接影响整个系统的稳定性和可靠性,是实现手臂控制的重要前提和基础。姿态解算需要依靠惯性测量器件,而MEMS器件由于具有小体积、低成本、低功耗等特点,因此成为前臂假肢惯性测量器件的首选。但是,由于MEMS器件容易受温度和外界噪声的影响,需根据姿态解算算法对其进行多传感器的数据融合,才能得到实时准确的姿态。

目前,常用的多传感器姿态解算算法有基于四元数的卡尔曼滤波[1]、基于四元数的扩展卡尔曼滤波[2]、欧拉角法等。其中,卡尔曼滤波所需计算量较大,在低频处理器上运行,其输出姿态的实时性和可靠性较低;……

登录APP查看全文