ROBOT2016_129-134_腱驱动空间五指灵巧手控制系统研究_韩冬

航天大学的 BH 系列灵巧手 [4] 和哈尔滨工业大学 的 DLR-HIT II 灵巧手 [5-7]．该类型灵巧手的优点是 控制精度高、迟滞小、易于模块化设计 [8] ，但由于 对电机、机构、硬件电路等的设计制造提出严格要 求，因此大大增加了技术复杂度和研制成本，同时 手指尺寸和重量也很难有效减小，限制了手指的灵 巧性． 驱动外置式灵巧手将传动机构和大部分的电气 系统置于前臂处，一方面可充分减小手指的尺寸 和重量，实现更灵活的操作，另一方面可采用大力 矩电机和腱绳驱动手指运动，使负载更大，例如美 国 R2 手 [9-11]、日本 Gifu 灵巧手 [12-13]、英国 Shadow 手．为了实现对腱驱动灵巧手的完全控制同时尽可
䟷 䳶 ঑ ⁑ ඇ
ᮠ ᦞ ᡻ ྇ ⁑ ඇ
⭥ ᵪ ᧗ ࡦ ⁑ ඇ л ս ᵪ 䖟 Ԧ

䟷 䳶 ঑
ᮠ ᦞ ᡻ ྇
图 3 灵巧手软件结构 Fig.3 Software system of the dexterous hand
2) 人机交互模块 人机交互界面是面向操作人员的，既可向操作 人员显示灵巧手系统的状态信息，也可响应操作人 员的命令．友好的人机交互界面可大大减轻操作人 员的工作负担，有利于实现对灵巧手的精确控制， 减少误操作率．根据在轨服务的任务要求，设计了 如图 4 所示的人机交互界面．
摘 要：以适用于空间在轨服务的腱驱动五指灵巧手为研究对象，设计具有一定实时性的控制系统．为满足 腱驱动灵巧手多指操作对同步性和实时性的特殊要求，提出基于 RTX（real time extension）共享内存的模块化软件 架构，可集成人机交互、虚拟显示、遥操作以及数据传输等模块，具有扩展性好、结构清晰、传输效率高的优点． 针对腱驱动耦合的问题，提出关节空间到腱空间的解耦矩阵，并据此给出实时多指协调运动控制方法，以确保各 手指同时到达期望位置，减小腱驱动迟滞造成的不利影响．最后通过多指灵巧抓取以及遥操作实验，验证所提控 制系统的稳定性、可靠性． 关键词：在轨服务；五指灵巧手；共享内存；多指协调 中图分类号：TP241 文献标识码：A 文章编号：1002-0446(2016)-02-0129-06
Abstract: A real-time control system is designed for a tendon-driven five-fingered dexterous hand for on-orbit service. In order to satisfy the special requirements for synchronism and real-timeness of multi-finger operation for tendon-driven hand, a modular software architecture based on RTX (real time extension) shared memory is proposed, which can integrate man-machine interface, virtual display, tele-operation and data transmission. This software architecture has virtues of good scalability, clear structure and high transmission efficiency. The decoupling matrixes from joint-space to tendon-space are presented to solve the problem of tendon-driven coupling, and they are used for the real-time coordinated motion control of multiple fingers to ensure the fingers simultaneously reach the desired positions and decrease the negative effects of tendondriven delay. Finally, the proposed control system is proven to be stable and reliable by the experiments of multi-finger dexterous grasp and tele-operation. Keywords: on-orbit service; five-fingered dexterous hand; shared memory; multi-finger coordination
4) 采集卡模块 读取采集卡的数据，并将其写入共享内存，以 便其他模块读取． 5) 数据手套模块 接收数据手套测量的人手关节信息，并将其写 入共享内存，以实现对灵巧手的遥操作． 6) 电机控制模块 从共享内存读取各电机的位移、速度命令并发 送给下位机，也可将电机的状态信息（实际位移） 写入共享内存． 该架构最大的优点是各功能模块独立运行，仅 依靠共享内存实现相互之间的通信，有利于实时控 制，便于搭建庞大的软件系统． 3.2 下位机软件 灵巧手下位机软件是在多轴运动控制器 GMAS 中实现的，它与上位机通过 Modbus/TCP 协议通信， 可实现多轴运动规划以及同步精确控制．
基金项目：中央高校基本科研业务费专项资金（NS2015085） ． 通信作者：韩冬，han dongnuaa@ 收稿／ 录用／ 修回：2015-12-27/2016-02-02/2016-02-21
130
机 器
人
2016 年 3 月
能减少驱动器的数量，可采用“N + 1”的腱驱动方 案，即 N + 1 根腱绳控制 N 个自由度的手指 [14] ，但 这种方式使得关节空间和腱绳空间存在耦合．为解 决该问题，文 [15] 建立了关节力矩到腱张力的映射 关系，而实际应用中由于摩擦力的影响，腱张力很 难精确获得． 腱驱动灵巧手可适应空间复杂、 恶劣的环境， 具有更高的灵巧性和安全性．但腱驱动也导致控制 精度较低、响应迟滞的问题．为此，本文针对腱驱 动灵巧手建立了高效的软、硬控制系统，给出基于 位置的关节空间到腱空间的解耦方法．为解决腱预 紧力不同和响应迟滞导致多指运动不同步和控制 精度不高的问题，提出了实时多指协调运动控制算 法．通过抓取实验验证了灵巧手控制系统的精确性 和稳定性．
第 38 卷第 2 期
韩冬，等：腱驱动空间五指灵巧手控制系统研究
131
本文利用 RTX （real-time extension）创建共享 内 存． RTX 是 美 国 IntervalZero 公 司 开 发 的 基 于 Windows 系统的实时解决方案，它拓展了 Windows 操作系统内核体系，实现独立的内核驱动模式，形 成与 Windows 操作系统并列的实时子系统 [16]．由 于 RTX 对传统的信号量机制进行了一些扩展，使 优先级倒置问题最小化，可有效解决共享内存互斥 访问的问题，保证灵巧手控制系统更实时、可靠地 运行．
它采用可靠性高、 实时性好、 传输速率快的 EtherCAT 接口，可通过自带的采集接口获取霍尔传感 器、增量式编码器和绝对式编码器的数据，以实现 对电机的精确控制．电机使用 Maxon 公司的 EC13 无刷直流电机，该电机具有加速快、转矩大、转速 范围广等优点，同时配备 ENX10 型编码器，可实 现高达 π/53248 rad 的分辨率，为灵巧手的精确控制 提供保证．
第 38 卷第 2 期 2016 年 3 月 DOI：10.13973/ki.robot.2016.0129
机器人
ROBOT
Vol.38, No.2 Mar., 2016
腱驱动空间五指灵巧手控制系统研究
韩 冬 1,2 ，聂 宏 1 ，陈金宝 1 ，颜文彧 1 ，王小涛 1
210016； 2. 上海宇航系统工程研究所，上海 201108） （1. 南京航空航天大学机械结构力学及控制国家重点实验室，江苏 南京
The Control System of the Tendon-Driven Space Five-fingered Dexterous Hand
HAN Dong1,2 ，NIE Hong1 ，CHEN Jinbao1 ，YAN Wenyu1 ，WANG Xiaotao1
(1. State Key Laboratory of Mechanics and Control of Mechanical Structures, Nanjing University of Aeronautics and Astronautics, Nanjing 210016, China; 2. Aerospace System Engineering Shanghai, Shanghai 201108, China)
4 㠚⭡ ᓖ᡻ᤷ 3 㠚⭡ ᓖ᡻ᤷ ⅐傡ࣘ ᡻ᤷ 䫒э㔣྇㇑ 傡ࣘᵪᶴ ‫ޣ‬㢲䀂ᓖ Րᝏಘ 㞅‫ޣ‬㢲 䟷䳶঑
ӄᤷ⚥ᐗ᡻ ᮠᦞ䟷 䳶঑ 䴽ቄՐᝏಘ ⻱䫒
图 2 控制系统硬件结构 Fig.2 Hardware structure of the control system
图 1 腱驱动灵巧手 Fig.1 Tendon-driven dexterous hand
кսᵪ ᮠᦞ᡻྇ GMASཊ䖤 䘀ࣘ᧗ࡦಘ ELMO 傡ࣘಘ

2
控制系统硬件结构（Hardware structure of the control system）
Maxon ⭥ᵪ
本文设计的腱驱动空间五指灵巧手如图 1 所 示，该灵巧手具有尺寸小、负载能力大、抗干扰能 力强的特点，共 12 个自由度，其中拇指 4 个，食指 和中指各 3 个，小指和无名指各 1 个，由 16 个电 机驱动并通过腱绳传动．
3
控制系统软件结构（Software structure of the control system）