CN108908345A - 一种欠驱动灵巧手传动系统状态感知系统 - Google Patents
一种欠驱动灵巧手传动系统状态感知系统 Download PDFInfo
- Publication number
- CN108908345A CN108908345A CN201811010444.8A CN201811010444A CN108908345A CN 108908345 A CN108908345 A CN 108908345A CN 201811010444 A CN201811010444 A CN 201811010444A CN 108908345 A CN108908345 A CN 108908345A
- Authority
- CN
- China
- Prior art keywords
- finger
- under
- load
- motor
- model
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1612—Programme controls characterised by the hand, wrist, grip control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Control Of Electric Motors In General (AREA)
- Manipulator (AREA)
Abstract
本发明提出了一种欠驱动灵巧手电气传动系统状态感知系统。本系统包括欠驱动灵巧手、信号采集模块、信号处理计算模块和系统运行状态判断模块。一般而言,传动系统由传动机构、执行机构和负载构成,其中任一部分发生异常或故障都可能导致整个系统无法正常工作。本发明基于欠驱动灵巧手的电机负载扰动模型和手指的动力学模型,导出欠驱动灵巧手电气传动系统的状态感知模型。通过检测和处理电机系统电气参数,得到特征参数值,结合状态感知模型可以快速准确的判断出传动系统的运行状态,从而提示操作者对系统进行即时管理。
Description
技术领域
本发明涉及电气传动系统感知模型,特别是一种欠驱动灵巧手传动系统状态感知系统利用电机系统参数感知欠驱动灵巧手传动系统运行状态,提供判断系统部件是否异常或故障的原理和依据。
背景技术
欠驱动灵巧手作为机器人与外部环境相互作用的执行部件--机器人末端执行器,克服了传统工业机器人末端夹持器灵活性差、缺少感知能力和精确的力控制等缺点,可以实现对多种物体的灵巧操作和精确控制,适应抓取任意形状物体,完成各种复杂的细微操作任务。灵巧手结合视觉传感器和触觉传感器可以自主完成一些抓取工作,如在空间站物品搬运等,而对于在家庭或医院中为人服务的机器人而言,它的末端执行器除了能完成基本动作之外,还需要高的安全性和稳定性,以保证人类与机器人之间的互动可以顺利进行。传统一般以增加触觉、视觉及温度等传感器增强灵巧手与外界环境的感知功能,如HIT/DLRI手的每根手指上都配置有12个传感器,传感器的增多不利于减小灵巧手体积、降低成本和提高控制精度。第二种方式则以数据手套的形式提高灵巧手操作的可靠性。该方式限制了灵巧手的应用推广,也提高了系统的成本。
本发明一种欠驱动灵巧手电气传动系统状态感知系统,通过分析运动系统正常工作时的电机系统参数,以及系统异常或故障时对电机系统电气参数的影响,即电机系统参数因为系统异常或故障而引起的变化,形成系统异常或故障时的电气参数特征,根据电气参数特征形成状态判别模型。通过检测和整合电机系统参数,结合该状态感知模型便可以获取电气传动系统运行状态信息,判断出运动系统是否发生异常或故障,以提示操作者及时对传动系统进行管理。利用电机系统参数感知欠驱动灵巧手传动系统的感知模型,结合电气参数可以简单、高效、准确地判断出传动系统的运行状态和健康状态,可提高系统运行的安全性,具有重要的学术价值和应用价值。
目前尚没有相似技术。
发明内容
本发明的目的在于针对已有技术的不足,提出一种欠驱动灵巧手传动系统状态感知系统,通过此系统可以使得欠驱动灵巧手的运行状态和健康状态能够被实时和准确的检测,保障系统运行的稳定性和安全性。
为达到上述目的,本发明采用下述技术方案:
一种欠驱动灵巧手传动系统状态感知系统,包括欠驱动灵巧手,其特征在于:所述欠驱动灵巧手经一个信号采集模块和一个信号处理计算模块连接一个系统运行状态判断模块。欠驱动灵巧手以传动机构-齿轮、执行机构-键绳和负载构成电机的泛负载,每个部分的负载特性不同。系统运行状态判断模块,通过分析灵巧手传动系统正常工作时与各部件异常工作时电机电气参数特征的变化规律,导出传动系统正常工作或各部分异常或故障时的模型。在该模型中,k为齿轮传动比;x为齿轮断齿数;kx为腱绳弹性系数;ks为腱绳劳损系数;Cm为转矩常数;Ce为反电动势常数;Cf为粘滞系数;Iav为稳态电枢电流平均值;fm为脉动频率;A为脉动幅度。
欠驱动灵巧手由1个手掌和5根欠驱动手指组成,各手指有4个指节、3个关节,其中拇指多一个向掌心弯曲的关节,共16个自由度。每个指尖上压力传感器,用于感知抓取物体的力度;电机转轴处装有电位计,用于检测电机的转角进而间接获得手指弯曲的位置信息。灵巧手要抓取物体时,电机正转经过齿轮箱后拉线牵引使手指弯曲;当要释放物体时,电机反转,手指背上的弹簧片将手指绷直。
信号采集模块主要用于采集电机电枢电流信号ia、电压信号Ua和压力信号F。
信号处理模块主要用于通过电流、电压信号获取电气参数特征值fm、Iav和A,并与系统正常时的特征值和A*做比较,得到可以用来感知系统状态的参数值Δfm、ΔIav和ΔA;通过该电气传动系统的传动模型其中ξ=c/2mwn,m和c分别为惯性矩阵和哥氏及阻尼矩阵中的元素,Kx为物体刚度,K3为等效对角弹簧刚度矩阵中的元素,l'为接触点到远指节的距离,F(s)和Ia(s)为F和ia的复数形式,以ia作为输入计算出F*,并与F进行比较得到ΔF。
系统运行状态判断模块包括传动系统正常工作模型、齿轮异常或故障模型、腱绳异常或故障模型、负载扰动模型,用于感知电气传动系统运行状态。
上述的欠驱动灵巧手包括5根欠驱动手指、1个手掌、6个驱动电机、腱绳、滑轮、压力传感器、角度传感器、弹簧片和集成控制器组成。每根手指具有4个指节,分别为远指节、中指节、近指节和基指节;三个关节,分别为关节一、关节二和关节三,各手指端部指腹上安装有压力传感器,用于感知抓取物体的力度;手掌容下6个驱动电机和集成控制器,与手指及其传动系统形成一体化结构。所述驱动电机为永磁直流减速电机,输出轴端有齿轮箱作为减速机构以输出更大的转矩,并且其中5个通过分别拉动腱绳控制手指的弯曲,与弹簧片配合控制手指的恢复,另外一个控制大拇指向掌心弯曲。所述腱绳一端固定在手指指端,另一端固定在滑轮上,而滑轮与电机输出轴固定在一起。所述角度传感器安装于电机转轴处,用于检测电机的转角进而间接获得手指弯曲的位置信息。
上述信号采集模块包括电流采集单元、电压采集单元和压力采集单元,用于完成对电流信号ia、电压信号Ua和压力信号的采集F。
上述信号处理模块包括稳态电流平均值计算单元、稳态电流脉动幅度计算单元;稳态电流脉动频率获取单元、基于电流信号的压力值计算单元和特征参数值比较单元。所述稳态电流平均值计算单元、稳态电流脉动幅度计算单元和稳态电流脉动频率获取单元以电流信号ia、电压信号Ua以及系统固定参数为输入,分别通过模型以及FFT分析得到特征参数值Iav、A和fm,其中fm是ia经FFT分析后电流频谱峰值对应的频率,系统固定参数为Ce、Cm、Cf、k、kx;所述基于电流信号的压力值计算单元以ia为输入经过上述模型G(s)后计算出压力值F*。所述特征参数值比较单元将当前获取的特征参数值fm、Iav、A和F*与电气传动系统正常工作时的电气特征参数A*和F进行比较,得到相对正常工作时的特征参数变化量Δfm、ΔIav、ΔA和ΔF。
上述的系统运行状态判断模块包括传动系统正常工作模型、齿轮异常或故障模型、腱绳异常或故障模型、负载扰动模型;通过观察Δfm、ΔIav、ΔA和ΔF的变化,感知电气传动系统运行状态。
所述传动系统正常工作模型为:Δfm=0,ΔIav=0,ΔA=0,ΔF=0;
当电气传动系统正常工作以及传感器无异常时,电气特征参数fm、Iav、A以及F*基本没有变化。由ΔF=0可知,ia与F之间可以相互验证,形成冗余信息,提高系统运行的可靠性。
所述齿轮异常或故障模型为:Δfm>0,ΔIav<0,ΔA>0。当手指抓住物体时,运动系统处于力矩闭环控制模式。正常情况下,电机的输出转矩与负载转矩基本一致。若齿轮发生断齿,故障的齿轮每啮合一次,负载转矩TL中便会出现一个负脉冲冲击。若以1代表系统正常工作时负载,以0代表空载,负载转矩TL则可以由脉冲波表征,脉动的频率取决于齿轮的传动比k和断齿的齿数x,fm和A增大。由于齿轮故障时负载转矩相对系统正常工作时变小,又电枢电流与电磁转矩成线性关系,因此Iav减小。
所述腱绳异常或故障模型为:ΔIav<0,Δfm<0,ΔA≈0。电机通过齿轮后拉动键绳使手指弯曲进行物体抓取,物体与手指之间会有一对作用力与反作用力,腱绳松弛或皮损会造成电机提供给手指的转矩不足且转矩传递具有滞后性,实际上是键绳的弹性系数kx减小,使得力反馈量减小,因此负载转矩TL减小,即Iav减小。若腱绳没有断开,其劳损过程是渐变的,即Iav的由大变小是连续的。由于转矩传递的滞后性,使得fm减小,又ia与Iav同步减小,A基本不变。
所述负载扰动模型为:ia骤增表征负载增大;ia骤减表征负载减小。当欠驱动灵巧手的手指未接触物体时,采用位置闭环控制策略,此时电机处于空载状态,ia=0,F=0;当手指开始接触物体时,采取力矩闭环控制策略,此时电机处于负载状态,且负载在逐渐增大,ia>0且逐渐增大,F>0且逐渐增大;当手指释放物体时,系统又从负载状态向空载状态转变,ia逐渐减小且趋于0,F逐渐减小直到为0。通过ia的动态变化可以直接反映出负载的变化,作为手指是否抓取物体的判断依据。
本发明与现有技术相比,具有如下显而易见的突出实质性和技术进步:
1)首次提出将传动部件、执行机构和负载构成电机泛负载的概念,将传动系统与执行机构的变化等效为负载的变化,以此来分析电机参数变化特性,具有创新性。
2)电机电枢电流信号与压力传感器信号之间可以相互验证,形成冗余信息,提高了系统的安全性和可靠性。
3)利用电机系统电气参数结合状态感知模型运行状态,进而实现欠驱动灵巧手的状态监测和健康管理,解决信息物理两个异构空间的融合,具有实用性和先进性。
4)获取状态感知的原理和方法以及模型本身均适用于其他运动系统,具有易推广性和拓展性
附图说明
图1为欠驱动灵巧手总成照片图。
图2为欠驱动灵巧手的系统结构示意图。
图3为欠驱动灵巧手手指爆炸图。
图4为欠驱动灵巧手的电机拉动键绳图。
图5欠驱动灵巧手运动控制系统结构图。
图6为电机负载扰动等效系统结构图。
图7为欠驱动机器人的抓取结构图
图8为欠驱动灵巧手运动系统扰动响应动态结构框图
图9为信号采集模块结构框图。
图10为信号处理模块结构框图。
图11为系统运行状态结构框图。
图12为齿轮故障稳态电流脉动波形图
图13为欠驱动灵巧手电气传动系统状态感知模型原理图
图14为欠驱动灵巧手电气传动系统运行状态判断依据表
具体实施方式
本发明的优选实施例结合附图详述如下:
实施例一:
参照图1~图5,本欠驱动灵巧手电气传动系统状态感知系统,包括欠驱动灵巧手(1),其特征在于,所示欠驱动灵巧手(1)经一个信号采集模块(2)和信号处理计算模块(3)连接一个系统运行状态判断模块(4);所述欠驱动灵巧手(1)以传动机构-齿轮、执行机构-键绳和负载构成电机的泛负载,每个部分的负载特性不同;所述系统运行状态判断模块(4),通过分析灵巧手传动系统正常工作时与各部件异常工作时电机电气参数特征的变化规律,导出传动系统正常工作或各部分异常或故障时的模型;在该模型中,k为齿轮传动比;x为齿轮断齿数;kx为腱绳弹性系数;ks为腱绳劳损系数;Cm为转矩常数;Ce为反电动势常数;Cf为粘滞系数;Iav为稳态电枢电流平均值;fm为脉动频率;A为脉动幅度;
所述欠驱动灵巧手(1),由1个手掌和5根欠驱动手指组成,各手指有4个指节、3个关节,其中拇指多一个向掌心弯曲的关节,共16个自由度;手掌用于固定手指、电机和控制器。每个指尖上贴有压力传感器,用于感知抓取物体的力度;电机转轴处装有电位计,用于检测电机的转角进而间接获得手指弯曲的位置信息。灵巧手要抓取物体时,电机正转经过齿轮箱后拉线牵引使手指弯曲;当要释放物体时,电机反转,手指背上的弹簧片将手指绷直;
所述信号采集模块(2)主要用于采集电机电枢电流信号ia、电压信号Ua和压力信号F;
所述信号处理模块(3)主要用于对电流、电压信号进行处理从而获取电气参数特征值fm、Iav和A,并与系统正常时的特征值和A*做比较,得到可以用来感知系统状态的参数值Δfm、ΔIav和ΔA;通过该传动系统的传动模型其中ξ=c/2mwn,m和c分别为惯性矩阵和哥氏及阻尼矩阵中的元素,Kx为物体刚度,K3为等效对角弹簧刚度矩阵中的元素,l'为接触点到远指节的距离,F(s)和Ia(s)为F和ia的复数形式,以ia作为输入计算出F*,并与F进行比较得到ΔF;
所述系统运行状态判断模块(4)包括传动系统正常工作模型、齿轮异常或故障模型、键绳异常或故障模型、负载扰动模型,用于感知传动系统运行状态;
实施例二:
本实施例与实施例一基本相同,其特别之处如下:
所述欠驱动灵巧手(1)包括5根欠驱动手指(11)、1个手掌(12)、6个驱动电机(13)、键绳(14)、滑轮(15)、压力传感器(16)、角度传感器(17)、弹簧片(18)和集成控制器(19),手指(11)具有4个指节,分别为远指节(111)、中指节(112)、近指节(113)和基指节(114);三个关节,分别为关节一(115)、关节二(116)和关节三(117),各手指端部指腹上安装有压力传感器(16),用于感知抓取物体的力度;手掌(12)容下6个驱动电机(13)和集成控制器(19),与手指及其传动系统形成一体化结构。所述驱动电机(13)为永磁直流减速电机,输出轴端有齿轮箱作为减速机构以输出更大的转矩,并且其中5个分别通过拉动键绳(14)控制手指的弯曲,与弹簧片(18)配合控制手指的恢复,另外一个控制大拇指向掌心弯曲。所述键绳(14)一端固定在手指指端,另一端固定在滑轮(15)上,而滑轮(15)与电机输出轴固定在一起。所述角度传感器(17)安装于电机转轴处,用于检测电机的转角进而间接获得手指弯曲的位置信息。
所述信号采集模块(2)包括电流采集单元(21)、电压采集单元(22)和压力采集单元(23),用于完成对灵巧手驱动电机电流信号ia、电压信号Ua和指尖压力信号F的采集。
所述信号处理模块(3)包括稳态电流平均值计算单元(31)、稳态电流脉动幅度计算单元(32)、稳态电流脉动频率获取单元(33)、基于电流信号的压力值计算单元(34)和特征参数值比较单元(35),所述稳态电流平均值计算单元(31)、稳态电流脉动幅度计算单元(32)和稳态电流脉动频率获取单元(33)以电流信号ia、电压信号Ua以及系统固定参数为输入,分别通过 模型以及FFT分析得到特征参数值Iav、A和fm,其中fm是ia经FFT分析后电流频谱峰值对应的频率,系统固定参数为Ce、Cm、Cf、k、kx;所述基于电流信号的压力值计算单元(34)以ia为输入经过所述模型G(s)后计算出压力值F*;所述特征参数值比较单元(35)将当前获取的特征参数值fm、Iav、A和F*与电气传动系统正常工作时的电气特征参数A*和F进行比较,得到相对正常工作时的特征参数变化量Δfm、ΔIav、ΔA和ΔF。
所述的系统运行状态判断模块(4)包括传动系统正常工作模型(41)、齿轮异常或故障模型(42)、异常或故障模型(43)和负载扰动模型(44);通过观察Δfm、ΔIav、ΔA和ΔF的变化,感知电气传动系统运行状态。
所述传动系统正常工作模型(41)为:Δfm=0,ΔIav=0,ΔA=0,ΔF=0;当传动系统正常工作以及传感器无异常时,电气特征参数fm、Iav、A以及F*基本没有变化,由ΔF=0可知,ia与F之间可相互验证,形成冗余信息,提高系统运行的可靠性;
所述齿轮异常或故障模型42为:Δfm>0,ΔIav<0,ΔA>0;当手指抓住物体时,运动系统处于力矩闭环控制模式;正常情况下,电机的输出转矩与负载转矩基本一致;若齿轮发生断齿,故障的齿轮每啮合一次,负载转矩TL中便会出现一个负脉冲冲击;若以1代表系统正常工作时负载,以0代表空载,负载转矩TL则可以由脉冲波表征,脉动的频率取决于齿轮的传动比k和断齿的齿数x,fm和A增大;由于齿轮故障时负载转矩相对系统正常工作时变小,又电枢电流与电磁转矩成线性关系,因此Iav减小;
所述腱绳异常或故障模型43为:ΔIav<0,Δfm<0,ΔA≈0;电机通过齿轮后拉动键绳使手指弯曲进行物体抓取,物体与手指之间会有一对作用力与反作用力,腱绳松弛或皮损会造成电机提供给手指的转矩不足且转矩传递具有滞后性,实际上是腱绳的弹性系数kx减小,使得力反馈量减小,因此负载转矩TL减小,即Iav减小;若腱绳没有断开,其劳损过程是渐变的,即Iav的由大变小是连续的。由于转矩传递的滞后性,使得fm减小,又ia与Iav同步减小,A基本不变;
所述负载扰动模型44为:ia骤增表征负载增大;ia骤减表征负载减小;当欠驱动灵巧手的手指未接触物体时,采用位置闭环控制策略,此时电机处于空载状态,ia=0,F=0;当手指开始接触物体时,采取力矩闭环控制策略,此时电机处于负载状态,且负载在逐渐增大,ia>0且逐渐增大,F>0且逐渐增大;当手指释放物体时,系统又从负载状态向空载状态转变,ia逐渐减小且趋于0,F逐渐减小直到为0。通过ia的动态变化可以直接反映出负载的变化,作为手指是否抓取物体的判断依据。
实施例三:
参照图1~图4,欠驱动灵巧手1包括五根欠驱动手指11、一个手掌12、6个驱动电机13、腱绳14、滑轮15、压力传感器16、角度传感器17、弹簧片18和集成控制器19组成。每根手指具有4个指节,分别为远指节111、中指节112、近指节113和基指节114;三个关节,分别为关节(1)115、关节(2)116和关节(3)117,各手指端部指腹上安装有压力传感器16,用于感知抓取物体的力度;手掌12容下六个驱动电机13和集成控制器19,与手指及其传动系统形成一体化结构。所述驱动电机13为永磁直流减速电机,输出轴端有齿轮箱作为减速机构以输出更大的转矩,并且其中五个分别通过拉动腱绳14控制手指的弯曲,与弹簧片18配合控制手指的恢复,另外一个控制大拇指向掌心弯曲。所述腱绳14一端固定在手指指端,另一端固定在滑轮15上,而滑轮15与电机输出轴固定在一起。所述角度传感器17安装于电机转轴处,用于检测电机的转角进而间接获得手指弯曲的位置信息。
图5为欠驱动灵巧手控制结构图。欠驱动灵巧手的驱动源为永磁直流电机;当手指未接触物体时,采取位置闭环控制策略;当手指接触到物体时,采取力矩闭环控制策略。假设直流电机电流是连续的,则其动态电压方程、反电动势EMF方程、电磁转矩方程可分别表示为:
Ea=Cen (2)
Te=Cmia (3)
其中,ia是电枢电流[A],Cm是转矩常数;Ce是反电动势常数;Ua是电枢电压[V];Ra是电枢电阻[Ω];La是电机电感[H];Ea是反电动势[V];Te是电磁转矩[Nm]。
电枢电路的电磁时间常数方程和机电时间常数方程可表示为:
Ta=La/R (4)
其中,Ta是电气时间常数;Tm是机电时间常数;J为转动常量。依据动能守恒原则可将传动轴和对象的转动惯量等效到电机轴上,进而得到电机旋转轴的动态方程:
负载电流定义式为:
TL是负载转矩[Nm],IdL是负载电流。进而推导得到如下的直流电机电气方程,得到电机负载扰动等效系统结构图如图6所示。
图7为欠驱动灵巧手的抓取结构图。为了简化系统模型,可以假定绳索是不可伸展的,手指的运动停留在水平面上,不受重力和摩擦的影响。因此可以模拟类似于皮带轮系统的肌腱驱动的系统特性,动力学模型可以推导如下:
M,f分别为质量和触摸力。转矩矢量T代表影响每个关节的外部转矩。M是3×3的对称正定惯性矩阵;K=diag[K1,K2,K3]是对角线弹簧刚度矩阵JT是雅可比转置矩阵;θ,分别是关节角度,角速度和角加速度矩阵;是离心和科里奥利力3×1力矢量矩阵。与物体接触的力变量f可以减小到恒定刚度的弹簧力模型。远端指骨位移x可以由方程(11)表示,其中手指需要被移动。l'是触点与物体的距离与滑轮3的中心之间的距离,kx为等效的弹簧弹性系数。
x=l'θ3 (11)
f=kxl'θ3 (12)
为了简化系统模型,可以促进欠驱动的机器人特性分析。由于假定接触力的方向是相同的,所以公式(13)由公式(10)~(12)导出:
对式(13)进行拉氏变换,可以得到手指关节驱动力矩和抓握力的动力学模型可以用二阶系统传递函数形式来表示:
其中ξ=c/2mwn。
结合图7和式(14),可以得到如图8所示的欠驱动灵巧手在力矩闭环控制模式下运动系统扰动响应动态结构框图。从图中可知直流电机电压的控制通过直流调压器实现,以电机电流为输入,抓取手指的力为输出的开环传递函数为:
设Cf为粘摩擦系数,Im为堵转电流,fm为电枢电流稳态脉动频率,A为脉动幅度,Iav为稳态电枢电流平均值,Ia为稳态电枢电流。
永磁直流电机在负载状态下的动态数学模型为:
可得永磁直流电机负载稳态电枢电流为:
永磁直流电机负载状态下电枢电流响应方程:
同时
参照图9,所述信号采集模块2包括电流采集单元21、电压采集单元22和压力采集单元23,用于完成对电流信号ia、电压信号Ua和压力信号的采集F。
参照图10,所述信号处理模块包括稳态电流平均值计算单元31、稳态电流脉动幅度计算单元32;稳态电流脉动频率获取单元33、基于电流信号的压力值计算单元34和特征参数值比较单元35。所述稳态电流平均值计算单元31、稳态电流脉动幅度计算单元32和稳态电流脉动频率获取单元33以电流信号ia、电压信号Ua以及系统固定参数为输入,分别通过模型以及FFT分析得到特征参数值Iav、A和fm,其中fm是ia经FFT分析后电流频谱峰值对应的频率,系统固定参数为Ce、Cm、Cf、k、kx;所述基于电流信号的压力值计算单元34以ia为输入经过上述模型G(s)后计算出压力值F*;所述特征参数值比较单元35将当前获取的特征参数值fm、Iav、A和F*与电气传动系统正常工作时的电气特征参数A*和F进行比较,得到相对正常工作时的特征参数变化量Δfm、ΔIav、ΔA以及压力变化值ΔF。
参照图11,所述的系统运行状态判断模块4包括传动系统正常工作模型41、齿轮异常或故障模型42、腱绳异常或故障模型43、负载扰动模型44;通过观察Δfm、ΔIav、ΔA和ΔF的变化,感知电气传动系统运行状态。
所述传动系统正常工作模型为:Δfm=0,ΔIav=0,ΔA=0,ΔF=0;
当电气传动系统正常工作以及传感器无异常时,电气特征参数fm、Iav、A以及F*基本没有变化。由ΔF=0可知,ia与F之间可以相互验证,形成冗余信息,提高系统运行的可靠性。
所述齿轮异常或故障模型为:Δfm>0,ΔIav<0,ΔA>0。当手指抓住物体时,运动系统处于力矩闭环控制模式。正常情况下,电机的输出转矩与负载转矩基本一致。若齿轮发生断齿,故障的齿轮每啮合一次,负载转矩TL中便会出现一个负脉冲冲击。若以1代表系统正常工作时负载,以0代表空载,负载转矩TL则可以由脉冲波表征,脉动的频率取决于齿轮的传动比k和断齿的齿数x,fm和A增大。TL呈周期性的波动,系统最终的稳态属于动态平衡。将周期性的波动分解为三角函数时,稳态转矩是在恒值的基础上叠加余弦分量:
由于电枢电流与电磁转矩成线性关系,则电机系统电枢电流跟随负载转矩的变化而周期性脉动,稳态脉动波形如图12所示。由于齿轮故障时负载转矩相对系统正常工作时变小,又电枢电流与电磁转矩成线性关系,因此Iav减小。
所述腱绳异常或故障模型为:ΔIav<0,Δfm<0,ΔA≈0。电机通过齿轮后拉动键绳使手指弯曲进行物体抓取,物体与手指之间会有一对作用力与反作用力,腱绳松弛或皮损会造成电机提供给手指的转矩不足且转矩传递具有滞后性,实际上是腱绳的弹性系数kx减小,使得力反馈量减小,因此负载转矩TL减小,即Iav减小。若腱绳没有断开,其劳损过程是渐变的,即Iav的由大变小是连续的。由于转矩传递的滞后性,使得fm减小,又ia与Iav同步减小,A基本不变。
所述负载扰动模型为:ia骤增表征负载增大;ia骤减表征负载减小。当欠驱动灵巧手的手指未接触物体时,采用位置闭环控制策略,此时电机处于空载状态,ia=0,F=0;当手指开始接触物体时,采取力矩闭环控制策略,此时电机处于负载状态,且负载在逐渐增大,ia>0且逐渐增大,F>0且逐渐增大;当手指释放物体时,系统又从负载状态向空载状态转变,ia逐渐减小且趋于0,F逐渐减小直到为0。通过ia的动态变化可以直接反映出负载的变化,作为手指是否抓取物体的判断依据。
综合以上叙述,可以得到如图13所示的欠驱动灵巧手电气传动系统状态感知模型原理图和图14所示的电气传动系统运行状态判断依据表。此模型和此表为利用电机系统电气参数感知电气传动机构运行状态提供了原理和方法。
以上显示和描述了本发明的基本原理、主要特征和本发明的优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是本发明的原理和方法,在不脱离本发明精神和范围的前提下发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明的范围内。本发明要求的保护范围由所附的权利要求书及其等同物界定。
Claims (5)
1.一种欠驱动灵巧手电气传动系统状态感知系统,包括欠驱动灵巧手(1),其特征在于,所示欠驱动灵巧手(1)经一个信号采集模块(2)和信号处理计算模块(3)连接一个系统运行状态判断模块(4);所述欠驱动灵巧手(1)以传动机构-齿轮、执行机构-键绳和负载构成电机的泛负载,每个部分的负载特性不同;所述系统运行状态判断模块(4),通过分析灵巧手传动系统正常工作时与各部件异常工作时电机电气参数特征的变化规律,导出传动系统正常工作或各部分异常或故障时的模型;在该模型中,k为齿轮传动比;x为齿轮断齿数;kx为腱绳弹性系数;ks为腱绳劳损系数;Cm为转矩常数;Ce为反电动势常数;Cf为粘滞系数;Iav为稳态电枢电流平均值;fm为脉动频率;A为脉动幅度;
所述欠驱动灵巧手(1),由1个手掌和5根欠驱动手指组成,各手指有4个指节、3个关节,其中拇指多一个向掌心弯曲的关节,共16个自由度;手掌用于固定手指、电机和控制器;每个指尖上贴有压力传感器,用于感知抓取物体的力度;电机转轴处装有电位计,用于检测电机的转角进而间接获得手指弯曲的位置信息;灵巧手要抓取物体时,电机正转经过齿轮箱后拉线牵引使手指弯曲;当要释放物体时,电机反转,手指背上的弹簧片将手指绷直;
所述信号采集模块(2)主要用于采集电机电枢电流信号ia、电压信号Ua和压力信号F;
所述信号处理模块(3)主要用于对电流、电压信号进行处理从而获取电气参数特征值fm、Iav和A,并与系统正常时的特征值和A*做比较,得到可以用来感知系统状态的参数值Δfm、ΔIav和ΔA;通过该传动系统的传动模型
其中ξ=c/2mwn,m和c分别为惯性矩阵和哥氏及阻尼矩阵中的元素,Kx为物体刚度,K3为等效对角弹簧刚度矩阵中的元素,l'为接触点到远指节的距离,F(s)和Ia(s)为F和ia的复数形式,以ia作为输入计算出F*,并与F进行比较得到ΔF;
所述系统运行状态判断模块(4)包括传动系统正常工作模型、齿轮异常或故障模型、键绳异常或故障模型、负载扰动模型,用于感知传动系统运行状态。
2.如权利要求1所述的欠驱动灵巧手传动系统状态感知系统,其特征在于:所述欠驱动灵巧手(1)包括5根欠驱动手指(11)、1个手掌(12)、6个驱动电机(13)、键绳(14)、滑轮(15)、压力传感器(16)、角度传感器(17)、弹簧片(18)和集成控制器(19),手指(11)具有4个指节,分别为远指节(111)、中指节(112)、近指节(113)和基指节(114);三个关节,分别为关节一(115)、关节二(116)和关节三(117),各手指端部指腹上安装有压力传感器(16),用于感知抓取物体的力度;手掌(12)容下6个驱动电机(13)和集成控制器(19),与手指及其传动系统形成一体化结构;所述驱动电机(13)为永磁直流减速电机,输出轴端有齿轮箱作为减速机构以输出更大的转矩,并且其中5个分别通过拉动键绳(14)控制手指的弯曲,与弹簧片(18)配合控制手指的恢复,另外一个控制大拇指向掌心弯曲;所述键绳(14)一端固定在手指指端,另一端固定在滑轮(15)上,而滑轮(15)与电机输出轴固定在一起;所述角度传感器(17)安装于电机转轴处,用于检测电机的转角进而间接获得手指弯曲的位置信息。
3.如权利要求1所述的欠驱动灵巧手传动系统状态感知系统,其特征在于:所述信号采集模块(2)包括电流采集单元(21)、电压采集单元(22)和压力采集单元(23),用于完成对灵巧手驱动电机电流信号ia、电压信号Ua和指尖压力信号F的采集。
4.如权利要求1所述的欠驱动灵巧手传动系统状态感知系统,其特征在于:所述信号处理模块(3)包括稳态电流平均值计算单元(31)、稳态电流脉动幅度计算单元(32)、稳态电流脉动频率获取单元(33)、基于电流信号的压力值计算单元(34)和特征参数值比较单元(35),所述稳态电流平均值计算单元(31)、稳态电流脉动幅度计算单元(32)和稳态电流脉动频率获取单元(33)以电流信号ia、电压信号Ua以及系统固定参数为输入,分别通过 模型以及FFT分析得到特征参数值Iav、A和fm,其中fm是ia经FFT分析后电流频谱峰值对应的频率,系统固定参数为Ce、Cm、Cf、k、kx;所述基于电流信号的压力值计算单元(34)以ia为输入经过所述模型G(s)后计算出压力值F*;所述特征参数值比较单元(35)将当前获取的特征参数值fm、Iav、A和F*与电气传动系统正常工作时的电气特征参数A*和F进行比较,得到相对正常工作时的特征参数变化量Δfm、ΔIav、ΔA和ΔF。
5.如权利要求1所述的欠驱动灵巧手传动系统状态感知系统,其特征在于:所述的系统运行状态判断模块(4)包括传动系统正常工作模型(41)、齿轮异常或故障模型(42)、异常或故障模型(43)和负载扰动模型(44);通过观察Δfm、ΔIav、ΔA和ΔF的变化,感知电气传动系统运行状态;
所述传动系统正常工作模型(41)为:Δfm=0,ΔIav=0,ΔA=0,ΔF=0;当传动系统正常工作以及传感器无异常时,电气特征参数fm、Iav、A以及F*基本没有变化,由ΔF=0可知,ia与F之间可相互验证,形成冗余信息,提高系统运行的可靠性;
所述齿轮异常或故障模型(42)为:Δfm>0,ΔIav<0,ΔA>0;当手指抓住物体时,运动系统处于力矩闭环控制模式;正常情况下,电机的输出转矩与负载转矩基本一致;若齿轮发生断齿,故障的齿轮每啮合一次,负载转矩TL中便会出现一个负脉冲冲击;若以1代表系统正常工作时负载,以0代表空载,负载转矩TL则可以由脉冲波表征,脉动的频率取决于齿轮的传动比k和断齿的齿数x,fm和A增大;由于齿轮故障时负载转矩相对系统正常工作时变小,又电枢电流与电磁转矩成线性关系,因此Iav减小;
所述腱绳异常或故障模型(43)为:ΔIav<0,Δfm<0,ΔA≈0;电机通过齿轮后拉动键绳使手指弯曲进行物体抓取,物体与手指之间会有一对作用力与反作用力,腱绳松弛或皮损会造成电机提供给手指的转矩不足且转矩传递具有滞后性,实际上是腱绳的弹性系数kx减小,使得力反馈量减小,因此负载转矩TL减小,即Iav减小;若腱绳没有断开,其劳损过程是渐变的,即Iav的由大变小是连续的;由于转矩传递的滞后性,使得fm减小,又ia与Iav同步减小,A基本不变;
所述负载扰动模型(44)为:ia骤增表征负载增大;ia骤减表征负载减小;当欠驱动灵巧手的手指未接触物体时,采用位置闭环控制策略,此时电机处于空载状态,ia=0,F=0;当手指开始接触物体时,采取力矩闭环控制策略,此时电机处于负载状态,且负载在逐渐增大,ia>0且逐渐增大,F>0且逐渐增大;当手指释放物体时,系统又从负载状态向空载状态转变,ia逐渐减小且趋于0,F逐渐减小直到为0;通过ia的动态变化可以直接反映出负载的变化,作为手指是否抓取物体的判断依据。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811010444.8A CN108908345B (zh) | 2018-08-31 | 2018-08-31 | 一种欠驱动灵巧手传动系统状态感知系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811010444.8A CN108908345B (zh) | 2018-08-31 | 2018-08-31 | 一种欠驱动灵巧手传动系统状态感知系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108908345A true CN108908345A (zh) | 2018-11-30 |
CN108908345B CN108908345B (zh) | 2023-07-14 |
Family
ID=64408061
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811010444.8A Active CN108908345B (zh) | 2018-08-31 | 2018-08-31 | 一种欠驱动灵巧手传动系统状态感知系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108908345B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111098323A (zh) * | 2020-01-19 | 2020-05-05 | 浙江工业大学 | 一种基于力与位移模糊混合控制的五指灵巧手及其控制方法 |
CN113400353A (zh) * | 2021-07-07 | 2021-09-17 | 西北工业大学 | 基于数字孪生的多指灵巧手状态监测方法、装置及设备 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050096873A1 (en) * | 2002-12-30 | 2005-05-05 | Renata Klein | Method and system for diagnostics and prognostics of a mechanical system |
CN101097440A (zh) * | 2006-06-27 | 2008-01-02 | 株式会社东芝 | 用于通过模拟来验证控制程序的装置和方法 |
CN101263499A (zh) * | 2005-07-11 | 2008-09-10 | 布鲁克斯自动化公司 | 智能状态监测和故障诊断系统 |
CN103429876A (zh) * | 2011-03-14 | 2013-12-04 | 通用电气公司 | 与电机联接的机械传动系的状况监测 |
CN104802181A (zh) * | 2015-04-09 | 2015-07-29 | 上海大学 | 机器人的三指灵巧手执行装置 |
CN107081787A (zh) * | 2017-04-01 | 2017-08-22 | 西安交通大学 | 基于工业机器人内置传感器信号的运动特性检测方法 |
CN108058188A (zh) * | 2017-11-24 | 2018-05-22 | 苏州灵猴机器人有限公司 | 机器人健康监测和故障诊断系统及其控制方法 |
CN108152736A (zh) * | 2017-12-07 | 2018-06-12 | 上海大学 | 利用电机系统参数监测负载变化与系统异常的自主感知系统 |
US20180169864A1 (en) * | 2015-05-21 | 2018-06-21 | Kastanienbaum GmbH | Method and device for open-loop/closed-loop control of an actuator-driven robot joint |
-
2018
- 2018-08-31 CN CN201811010444.8A patent/CN108908345B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050096873A1 (en) * | 2002-12-30 | 2005-05-05 | Renata Klein | Method and system for diagnostics and prognostics of a mechanical system |
CN101263499A (zh) * | 2005-07-11 | 2008-09-10 | 布鲁克斯自动化公司 | 智能状态监测和故障诊断系统 |
CN101097440A (zh) * | 2006-06-27 | 2008-01-02 | 株式会社东芝 | 用于通过模拟来验证控制程序的装置和方法 |
CN103429876A (zh) * | 2011-03-14 | 2013-12-04 | 通用电气公司 | 与电机联接的机械传动系的状况监测 |
CN104802181A (zh) * | 2015-04-09 | 2015-07-29 | 上海大学 | 机器人的三指灵巧手执行装置 |
US20180169864A1 (en) * | 2015-05-21 | 2018-06-21 | Kastanienbaum GmbH | Method and device for open-loop/closed-loop control of an actuator-driven robot joint |
CN107081787A (zh) * | 2017-04-01 | 2017-08-22 | 西安交通大学 | 基于工业机器人内置传感器信号的运动特性检测方法 |
CN108058188A (zh) * | 2017-11-24 | 2018-05-22 | 苏州灵猴机器人有限公司 | 机器人健康监测和故障诊断系统及其控制方法 |
CN108152736A (zh) * | 2017-12-07 | 2018-06-12 | 上海大学 | 利用电机系统参数监测负载变化与系统异常的自主感知系统 |
Non-Patent Citations (1)
Title |
---|
陈柏峰;周思跃;: "多指灵巧手抓取球体的规划与实现" * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111098323A (zh) * | 2020-01-19 | 2020-05-05 | 浙江工业大学 | 一种基于力与位移模糊混合控制的五指灵巧手及其控制方法 |
CN113400353A (zh) * | 2021-07-07 | 2021-09-17 | 西北工业大学 | 基于数字孪生的多指灵巧手状态监测方法、装置及设备 |
CN113400353B (zh) * | 2021-07-07 | 2024-02-02 | 西北工业大学 | 基于数字孪生的多指灵巧手状态监测方法、装置及设备 |
Also Published As
Publication number | Publication date |
---|---|
CN108908345B (zh) | 2023-07-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Verstraten et al. | Series and parallel elastic actuation: Impact of natural dynamics on power and energy consumption | |
CN101332604B (zh) | 人机相互作用机械臂的控制方法 | |
CN100413657C (zh) | 控制机械手的方法 | |
Kong et al. | A compact rotary series elastic actuator for human assistive systems | |
Beckerle et al. | Series and parallel elastic actuation: Influence of operating positions on design and control | |
US9073208B2 (en) | Gripper apparatus and method for controlling the same | |
CN108908345A (zh) | 一种欠驱动灵巧手传动系统状态感知系统 | |
Mayetin et al. | Design and experimental evaluation of a low cost, portable, 3-dof wrist rehabilitation robot with high physical human–robot interaction | |
Yin et al. | Compliant control of single tendon-sheath actuators applied to a robotic manipulator | |
CN206720532U (zh) | 自动识别门质量的电梯门机控制装置 | |
Suzuki et al. | Single-inertialization based on high-backdrivability control using equivalent disturbance compensator for human interaction robot | |
Kanai et al. | Torque-sensorless control for a powered exoskeleton using highly back-drivable actuators | |
Xu et al. | Back-drivability improvement of geared system based on disturbance observer and load-side disturbance observer | |
Guo et al. | Data driven calibration and control of compact lightweight series elastic actuators for robotic exoskeleton gloves | |
Dyck | Measuring the dynamic impedance of the human arm | |
Hu et al. | Disturbance rejection speed control based on linear extended state observer for isokinetic muscle strength training system | |
WO2023207344A1 (zh) | 机械臂及机器人 | |
Kawai et al. | High-robust acceleration control using force and position sensors integrated disturbance observer | |
Anooshahpour et al. | A motion transmission model for a class of tendon-based mechanisms with application to position tracking of the da Vinci instrument | |
Wang et al. | Data glove control of robot hand with force telepresence | |
Ohashi et al. | Nonlinear disturbance compensation for haptic device | |
Du et al. | A review of powered backdrivability of robot actuators for human-robot interaction | |
JPS6072004A (ja) | ダイレクト教示型工業用ロボットの制御装置 | |
Li et al. | Design and implementation of a compact master-slave robotic system with force feedback and energy recycling | |
Kwak et al. | Wire-tension control using compact planetary geared elastic actuator |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |