2024年6月6日发(作者:)

中南工业大学学报          

第29卷专辑

J. CENT. SOUTH UNIV. TECHNOL

1998年5月

用于多指灵巧手的智能数据采集系统

何永强张启先李大寨王国庆

(北京航空航天大学机瑟人研究所,北京,100083)

摘要本文研制丁一种用于多指灵巧手的4能数据未集系统,它与传统的数据采集未统不同,本介带有

两片CPU.可以在没有其它CPU参与的情况下,自主地完成数据米集和处理,并可代替高层计早机完成那

分重复而费时的工作.它可以用于多指灵巧手和智能机吞人系统,大大减径了高层计葬机的负担,吏有利于

分层递阶控制.本文详细介绍了该系统的硬件组成和工作原理,并且给出丁数据处理程序的界法和实现,

关锐词数据采集;数据处理;多指灵巧手

器,共27路信号通过智能数据采集系统采集和处

1引言

理后送到高层供主控微机控制使用.下面介绍智能

数据采集系统的硬件组成和软件设计.

    机器人的智能离不开各种传感器,所以数据采

集系统便成为智能机器人的必要组成部分.以往的

数据采集系统大多是由模/数转换器以其外围芯片

构成,而无中央处理单元,只能完成模拟信号向数

dt

三指灵巧手

字信号的转换,而其工作的控制、数据的处理都必

须由其它CPU如分布控制系统的主控微机来完

图1  BH-3三指灵巧手未统结构

成.智能机器人通常采用多CPU分布控制系统和

分层递阶控制方式用主控微机来完成繁重的数据

2硬件组成

采集任务不仅给主控微机带来很大的负担,而且分

层不明显,不利于分层递阶控制.本文研制了一种

    智能数据采集系统总体结构如图2所示.系统

智能数据采集系统,本身带有CPU,可以不在主控

由两片8098单片机分别和模/数转换器AD1674一

微机的参与下自主地完成数据采集和处理.主控微

起构成两套数据采集和处理系统,分别处理来自关

机只要简单地发一条命令,它就能把处理好的数据

节位置传感器和指端力传感器的数据来自传感器

送上来,大大减轻了主控微机的负担,使其更好地

的信号经过放大解祸后通过多路模拟开关切换分时

完成上层任务.此外智能数据采集系统还可以完成

传给A/D转换器,经过A /D转换由模拟信号变为

原来由主控微机完成的部分重复、费时但又很重要

数字信号再送到8098单片机进行处理两片8098

单片机则通过公用RAM与主控微机PC进行数据

的工作,如对机械本体的运动状态进行监测等.此

交换.

系统已用于北京航空航天大学研制的BH-3三指灵

巧手中,运行效果良好.

北京航空航天大学研制的BH-    3三指灵巧手有

三个指九个关节其控制系统采用分层控制结构,

两级计算机控制,高层用PC机作为主控微机,负

责系统管理、轨迹规划和高级控制算法的实现,底

层由九个单片机分别对九个电机进行伺服控制,系

统结构如图1所示.灵巧手的各个关节分别装有关

爵CP   喘A? F}Y,86g   9s 8   a AM/UR  A}} i`c'}i %i3f

节位置传感器,各手指的指端装有六维指端力传感

图2七能数据采集澳统结构

  

中南工业大学学报

第29卷专辑

2.1 8098单片机与主控徽机的通讯

片机的应答线来确定当前公用RAM是否在使用,

两片8098单片机与主控微机PC间的通讯通    

以清除竞争和重复中断,各8098单片机通过口

过公用RAM实现,这种方法传送数据效率高,数

P2. 1查询由PC机扩展1/O口(74LS273)发出的应

据吞吐量大,且数字传送简便灵活,其原理如图3

答线来确定PC机中断请求是否有效,以避免误响

所示.PC机与两片8098单片机共同使用1片

应和重复响应遇紧急情况时智能数据采集系统的

RAM作为外部存储器它们之间的数据交换均通

8098单片机还可通过口P0. 5向PC机发出中断请

过这片公用RAM进行.由PC机通过扩展I/O口

求,PC机通过查询扩展1/O口(74LS245)判断各

(74LS273)控制分配器(74LS139)管理各CPU对公

中断源并作相应处理,通过扩展1/O口(74LS273)

用RAM的使用.当PC机将分配器的YO输出端

清除中断.

置低电平时,使PC机和公用RAM之间的总线隔

2.2 8098单片机与A/D转换器的接口

离0的允许端就绪,PC机获得公用RAM使用权,

本文选用了AD1674作为模/数转换器,    

与此同时分配器的其它输出端一直保持高电平,则

AD1674是12位逐次通近型模/数转换器.片内带

D触发器的输出端Q为高电平,总线隔离1, 2的

有采样保持器,故不需外加采祥保持器就可以和模

允许端无效,两片8098单片机与公用RAM被阻

拟输入直接相连,芯片内设有三态输出缓冲电路,

隔当分配器输出端Y。为高电平时,PC机放弃公

可以不用外部接口电路直接连到8位或16位微处

用RAM的使用权.当PC机将分配器输出端Yl,

理机总线上,AD1674的转换速度为10 [Ls,输入模

Y2中的某一个置为低电平时,则向相应的8098单

拟信号范围可为0-10 V或。-20V,也可为双极

片机发出中断请求信号,通知其使用公用RAM,

性士5V或士10 V. 8098单片机与A/D转换器的

该8098单片机响应中断并将应答线P2. 0置低电

接口如图4所示.各路传感器信号经放大调整后变

平,使分配器无效,相应输出端由低变高,而D触

为O- IO  V的电压,由多路模拟开头AD7506和

发器的输入端为低电平,则Q端由高变低,使该单

AD7511分时选通送到AD1674的输入端(SPN),

片机总线隔离的允许端有效,获得公用RAM的使

共享A/D转换器.AD1674的转换和数据的读取由

用权,同时分配器的其它输出端为高电平,阻隔其

8098单片机通过控制信号CE, CS, R/C和12/8控

它CPU与公用RAM的通讯,使用结束后该单片

制.当8098单片机向AD1674写选通地址(Ao=O)

机将应答线P2。置为高电平,放弃公用RAM的

时,CE二1. CS=O, ADC1674处于工作状态,这时

使用权.

置P2.5为低电平,启动A/D转换,然后8098单片

PC机通过扩展I    /O(74LS245)查询各8098单

机查询STS状态,看转换是否完毕,数据转换完毕

RAM

‘      

DOQ

SD口  

t47i1,t14

7244L5S

t工〕厂

rr-

I创L

1二I

卜。.5I

刁l

下门尸

一              

I U0'Q

CD Q

I7347IL3S

7143L95

YY1U

图38098单片机与主控徽机通讯原理

1998年5月

伺水强等:用于多指灵巧手的智能教据采集系统

后,再读同一地址,同时置P2.5为高电平,此时

CS=O, CE=1, R汇=1,又由于12/8=0, Aa=O,

所以AD1674的高8位并行输出数据有效待读完

高8位数据后,地址加1再一次读取,则Ao=1,

而其它控制信号不变,故AD1674的低4位数据加

上尾随的4个0有效.从而读到12位数据,完成

A/D转换过程.

图4 8098单K机与A/D转换毖接v

3数据处理

    从硬件组成可以看到,智能数据采集系统已不

是简单的数据转换系统,而是由双CPU构成的完

整的计算机系统,它不仅可以对模/数转换过程进

行控制,而且可以对采集的数据进行处理和应用.

由于各种干扰的存在,采集到的数据不能直接用于

控制,除采用中值平均的滤波方法抑制随机噪声

外,还必须针对关节位置传感器和力传感器的不同

性质进行不同的处理.

31关节位置传感器数据的处理

对于关节位置传感器来说,由于毛刺及其它干    

扰的存在,有时会出现奇异值.这对系统的控制是

非常不利的,因为电位器的反馈信号直接用于系统

的位置控制,其值的跳动会使手指运动不平稳,甚

至产生抖动所以在信号送到高层微机之前必须剔

除原始数据中的奇异项.这里采用了简单的一阶差

分检查奇异项的方法,因为手指的运动相对于采样

频率变化极其缓慢,可以认为电位器相邻的两个数

据点的差是相等的.当系统上电时可用中值平均的

方法得到点K一2和K一I的数据XK_ 11 XK_,,

则按一阶差分方程预测出K时刻的估计值:

戈*=X,        ;_1+(XK-,一XK-,)       (1)

假定K时刻的实测值为XK,把X、与式(    )I推

出的估计值XA相比,判断X二是否是奇异项.判断

的标准是:根据数据采集系统的精度给定一个误差

窗口w,若}X二一戈二}>w,则认为此采样值X,;

是奇异项,必须剔除,而以X二取代实际采样值

Xx.剔除奇异项的程序框图如图5所示.

图5  4}1w奇异'ifa序1 v L8

3.2指端力传感器数据的处理

三指灵巧手采用应变片式六维指端力传感器,    

它在把广义位移转换为电信号的过程中呈非线性关

系,而在硬件解祸过程中,非线性解藕是很困难的

且效果不佳,所以采用了线性解祸的方法.这样六

维力传感器的非线性很难消除.为了解决这个问

题,本文设计了力传感器信号线性化的程序,用软

件的方法进行非线性补偿.设力传感器某路信号的

输入一输入特性如图s所示,图中x为被测参量,y

为输出量,它们是非线性关系,且y二f(x),把图

中的输入量x分成。个均匀的区间,每个区间的端

点二,都对应一个输出Y+,把这些XA, Y;编制成表格

存贮起来.实际的测量值二,一定会落在某个区间

叶*,x++」内,即二。簇x镇x-,则利用Lagrange

线性插值公式可得

x,一                      x-     x』一x.、

xA一                  xA_]一xA}}一xA

3.3灵巧手运行状态的监测和报带

除了对数据的自动采集和处理外,智能数据采    

集系统还可以对处理后的数据进行分析和应用,代

替主控微机做一些经常、重复、费时但又很重要的

工作.本文应用关节位置和指端力传感器的信息对

灵巧手的手指运动和指端力进行检测和监视.当发

现系统的运行状态异常或遇紧急危险情况时.向主

中南工业大学学报

第29卷专辑

1!!1

,1

。一wil二,,二刀

・一石二

困6力传感界的愉出一精入特性

控微机发出报普信号,由主控微机采取相应的措

施.

    监测手指运动状态是通过对关节位置的分析实

现的,采集到关节位置电位计的数据并处理后,便

可计算出各关节的实际角度。二((a