一种上假肢手部姿态自平衡控制系统技术方案

本实用新型专利技术公开了一种上假肢手部姿态自平衡控制系统，它包括手部平衡控制器和固定在上假肢前臂上的电压型双轴倾角传感器，手部平衡控制器通过串口与上假肢的前臂扭转舵机和手腕俯仰舵机连接；所述的手部平衡控制器由MCU、模数转换电路、电源管理模块和串口连接组成。在手臂做运动时，传感器将实时检测到的前臂姿态变化数据信息通过控制器内部的模数转换电路发送到控制器内，控制器可以根据传感器检测到的倾斜角度，来自动调节前臂扭转舵机和手腕俯仰舵机的旋转方向及转角大小，以使上假肢手部的虎口方向保持垂直向上，实现了手臂做任意的上下、左右、前后运动时，都能够自动保持上假肢或机械手的手部姿态平衡稳定。（*该技术在2022年保护过期，可自由使用*）

【技术实现步骤摘要】

本技术涉及残疾人用的上假肢或机器人机械手，尤其涉及上假肢手部在移动中自动维持姿态平衡的控制技术。
技术介绍
通常，人们从桌子上端起一杯水放到嘴边饮用，在移动过程中必须要保持水杯的姿态维持不变，否则水就会洒出。对于人来说这是很简单平常的一个动作，可对于机器人或上假肢来说实现起来就有很大的难度。机器人或上假肢要完成一些抓放作业，事先必须要描述出来手部的起始状态(注所谓“状态”包含位置与姿态两种信息)和目标状态，以便使得其手部能准确抓取到物·体并将其以要求的姿态放到需要的地方。而对于端水杯那样的一些特殊抓放作业，不仅要描述手部的起始状态和目标状态，还需要指明手部移动过程中在起始状态和目标状态之间的若干途径点处的状态，以保证水杯在移动过程中姿态稳定，不至于发生倾斜而洒落杯中水，这就要对机械手的运动进行连续轨迹规划。轨迹规划一般有两种方式，一种是在关节空间进行轨迹规划，一种是在笛卡尔空间进行轨迹规划。在关节空间内的轨迹规划，虽然计算速度快，易于实时进行，但是却往往无法保证移动过程中手部姿态的维持，在端水杯这样的工作中明显不适用。要实现手部移动过程中杯子中的水不洒落，必须要在笛卡尔空间中进行轨迹规划。而在笛卡尔空间的轨迹规划，需要在笛卡尔空间与关节空间之间进行实时映射，这是一个计算量很大的任务，常常导致较长的控制间隔；再者，由笛卡尔空间向关节空间的变换是病态的，它不是一对一的映射；另外，由于假手的工作对象的起始状态和目标状态都是随机的，对于起始状态和目标状态的描述尚且难以实现，而对其途径状态点的描述更是困难重重。所以要保持端水杯移动过程手部姿态的维持不变非常不易。技术内容本技术的目的是公开一种保证上假肢或机械手的手部姿态在运动过程中自动维持平衡的控制系统。通过该系统，可以在手臂做任意的上下、左右、前后运动时，都能够自动保持上假肢或机械手的手部姿态平衡稳定。本技术的技术方案是一种上假肢手部姿态自平衡控制系统，它包括手部平衡控制器和固定在上假肢前臂上的倾角传感器，手部平衡控制器通过串口与上假肢的前臂扭转舵机和手腕俯仰舵机连接；所述的手部平衡控制器由MCU、模数转换电路、电源管理模块和串口连接组成。上述倾角传感器是一种电压型双轴倾角传感器，为现有结构。本技术的工作方法如下第一步倾角传感器的安装将倾角传感器安装在受前臂扭转舵机驱动的前臂的某一个位置上，倾角传感器安装要求如下倾角传感器在前臂的上下位置允许变化，但是一定要保证倾角传感器的X轴和Y轴所构成的平面与此时手部虎口所处的平面平行，而且一定要保证倾角传感器的X轴的方向与前臂的中轴线平行，Y轴的方向与前臂的中轴线垂直；第二步控制上假肢手部姿态保持平衡，具体分为以下两个方面一 控制手腕俯仰舵机保持平衡 当手部平衡控制器接收到倾角传感器实时测得的倾角传感器的X轴向下偏离水平面并和水平面形成一个夹角时，则手部平衡控制器就会控制手腕俯仰舵机上抬相应的角度；同理，手部平衡控制器接收到倾角传感器实时测得的倾角传感器的X轴向上偏离水平面并和水平面形成一个夹角时，则手部平衡控制器就会控制手腕俯仰舵机下落相应的角度；当手部平衡控制器接收到倾角传感器实时测得的倾角传感器的X轴与水平面平行时，则手部平衡控制器就不需要控制手腕俯仰舵机转动。二控制前臂扭转舵机保持平衡当手部平衡控制器接收到倾角传感器实时测得的倾角传感器的Y轴向下偏离水平面并和水平面形成一个夹角时，说明假肢手部虎口向身体内侧倾斜，手部平衡控制器就会控制前臂扭转舵机向身体外侧转动，带动前臂及安装在其上面的倾角传感器向身体外侧转动，使倾角传感器的Y轴方向由向下偏离水平面逐渐向与水平面平行变化；当手部平衡控制器接收到倾角传感器实时测得的倾角传感器的Y轴向上偏离水平面并和水平面形成一个夹角时，说明假肢手部虎口向身体外侧倾斜，手部平衡控制器就会控制前臂扭转舵机向身体内侧转动，带动前臂及安装在其上面的倾角传感器向身体内侧转动，使倾角传感器的Y轴方向由向上偏离水平面逐渐向与是平面平行变化；当手部平衡控制器接收到倾角传感器的Y轴与水平面平行时，说明此时假肢手部的虎口方向垂直向上，这样手部平衡控制器就不需要控制前臂扭转舵机转动。下面根据工作原理说明本技术的积极效果。本技术的目的主要是控制上假肢或机械手在一些特殊操作过程中手部虎口方向始终保持垂直向上，基于这一机理，本技术的工作原理是，在手臂做上下、左右、前后等运动时，倾角传感器将实时检测到的前臂姿态变化数据信息通过手部平衡控制器内部的模数转换电路发送到手部平衡控制器内，手部平衡控制器可以根据倾角传感器的X轴和Y轴分别相对于水平面的倾斜角度，来自动调节前臂扭转舵机和手腕俯仰舵机的旋转方向及转角大小，以使上假肢手部的虎口方向保持垂直向上，来保持手部姿态的平衡维持；上述的前臂姿态变化数据信息包括两个倾斜角度，一是倾角传感器的X轴相对于水平面的倾斜角度，即人体的前后方向，二是倾角传感器的Y轴相对于水平面的倾斜角度，即人体的左右方向。因此通过该系统，实现了手臂做任意的上下、左右、前后运动时，都能够自动保持上假肢或机械手的手部姿态平衡稳定，解决了人们长期以来无法解决的难题。附图说明下面以右侧上假肢为例说明本技术的实施例。图I是上假肢手部姿态自平衡控制原理框图；图2是上假肢自然下垂时倾角传感器与上假肢的安装位置关系图；图3是前臂向上抬起到水平位置时，手部虎口朝上示意图；图4是前臂向上抬起到水平位置时，手部虎口朝内示意图；图5是前臂向上抬起到水平位置时，手部虎口朝外示意图；图6是前臂上抬一个角度但是还未到达水平位置时，手腕俯仰舵机未做平衡调整前手部姿态示意图；图7是前臂上抬一个角度但是还未到达水平位置时，手腕俯仰舵机做平衡调整后手部姿态示意图；图8是前臂上抬一个角度并且超过水平位置时，手腕俯仰舵机未做平衡调整前手 部姿态示意图；图9是前臂上抬一个角度并且超过水平位置时，手腕俯仰舵机做平衡调整后手部姿态示意图；图10是倾角传感器上的X轴和Y轴方向示意图；图11是手部平衡控制器的电路框图。图中I-手部平衡控制器，2-倾角传感器，3-前臂扭转舵机，4-手腕俯仰舵机，5-倾角传感器的X轴，6-倾角传感器的Y轴，7-MCU，8-电源管理模块，9-串口，10-模数转换电路。具体实施方式下面根据附图对本技术的实施例进一步说明。如图I、图2所示，本技术上假肢手部姿态自平衡控制系统，是在上假肢的前臂上固定有倾角传感器2，它还包括有手部平衡控制器1，手部平衡控制器I通过串口 9与上假肢的前臂扭转舵机3和手腕俯仰舵机4连接；倾角传感器2将实时检测到的前臂姿态变化数据信息通过手部平衡控制器I内部的模数转换电路10发送到手部平衡控制器I内，手部平衡控制器I实时控制调整前臂扭转舵机3和手腕俯仰舵机4的运动方向和角度，从而使手部虎口方向保持垂直向上；上述的前臂姿态变化数据信息包括两个倾斜角度，如图10所示，一是倾角传感器2的X轴5相对于水平面的倾斜角度，即人体的前后方向，二是倾角传感器2的Y轴6相对于水平面的倾斜角度，即人体的左右方向；其中如图11所示，所述的手部平衡控制器I由MCU7、电源管理模块8、串口 9和模数转换电路10连接组成。为了便于实施，根据图2-10再描述实施例的工本文档来自技高网...

【技术保护点】
一种上假肢手部姿态自平衡控制系统，它包括手部平衡控制器和固定在上假肢前臂上的倾角传感器，手部平衡控制器通过串口与上假肢的前臂扭转舵机和手腕俯仰舵机连接；所述的手部平衡控制器由MCU、模数转换电路、电源管理模块和串口连接组成；上述倾角传感器是一种电压型双轴倾角传感器。

【技术特征摘要】
1.一种上假肢手部姿态自平衡控制系统，它包括手部平衡控制器和固定在上假肢前臂上的倾角传感器，手部平衡控制器通过串口与上假肢的前臂扭转舵机和...

【专利技术属性】
技术研发人员：樊炳辉，纪鹏，赵振爱，李建功，周凯，
申请(专利权)人：山东科技大学，
类型：实用新型
国别省市：