[0039] 式似和式（3)中，f郝f2分别表示第一根非线性弹黃1与第二根弹非线性黃2 产生的力，XI和X2分别表示第一根非线性弹黃1与第二根非线性弹黃2的伸缩量，而k为 第一根非线性弹黃1与第二根非线性弹黃2的比例系数。
[0040] 步骤2、如图3所示，包括微处理器4和机械构造第一部分，机械构造第一部分包括 第一个电机5和第二个电机6作为驱动电机，第一根转轴7和第二根转轴8负责驱动电机 产生的扭矩输出，第一个减速机构9和第二个减速机构10负责降速并提高输出扭矩，第一 个齿轮11，第一根蜗杆13和第二个齿轮12,第二根蜗杆14组成两个齿轮蜗杆，将输出扭矩 转换为水平拉力，控制非线性弹黃的伸缩量。
[0041] 如图4所示，包括机械构造第二部分，包括第一根蜗杆13和第二根蜗杆14,第一根 非线性弹黃15和第二根非线性弹黃16和输出转杆17。
[0042] 下面将详细介绍微处理器和输出力矩和刚度之间的关系。
[0043] 对于关节驱动器给定输出力矩τ，它与两根非线性弹黃产生的弹力和f2的关 系如下： 阳044] τ=fiLi-fzLz， (4) W45] 上式中，τ为转杆17处输出力矩，和f2分别表示第一根非线性弹黃15和第二 根非线性弹黃16所受弹力，而Li和L2分别表示第一根非线性弹黃15和第二根非线性弹黃 16受力处到转轴的距离，即分别是第一根非线性弹黃15和第二根非线性弹黃16的力臂。 [0046] 而两个力臂分别可W表示为： 阳047] Li=L+X1， (5)
[0048] L2=L+x2. 巧） W例上式中，如图3所示，Li和Lz分别表示第一根非线性弹黃15和第二根非线性弹黃 16受力处到转轴的距离，L为第一根非线性弹黃15和第二根非线性弹黃16的原长，XI和 X2分别表示第一根非线性弹黃15与第二根非线性弹黃16的伸缩量。
[0050] 则整理上面各式，将转杆处输出力矩表示为： W川
（7)
[0052] 上式中，τ为转杆17处输出力矩，k为第一根非线性弹黃15与第二根非线性弹黃 16的比例系数，L为第一根非线性弹黃15和第二根非线性弹黃16的原长，和X2分别表 示第一根非线性弹黃15与第二根非线性弹黃16的伸缩量。
[0053] 步骤3、给定输出刚度K'是给定输出力矩τ和转角Θ的导数，即： 幽
(8) 阳化5] 上式中，Κ'为输出刚度，τ和Θ分别表示输出力矩和转角。
[0056] 考虑到转杆处转角Θ与两根非线性弹黃伸缩量之间的关系：
[0057] 目=(Xi-X2)/R， (9)
[0058] 上式中Θ为转杆17处转角，R为转杆17自身的半径，和X2分别表示第一根非 线性弹黃15与第二根非线性弹黃16的伸缩量。则给定输出刚度K'和第一根非线性弹黃 15和第二根非线性弹黃16的伸缩量和X2之间的关系： 蜘9]
， 纖
[0060]良P:
[0063] 上式中，Κ'为给定输出刚度，xi和X2分别为第一根非线性弹黃15和第二根非线 性弹黃16的伸缩量，R为转杆17自身的半径，k为第一根非线性弹黃15与第二根非线性弹 黃16的比例系数，L为第一根非线性弹黃15和第二根非线性弹黃16的原长。可W得到机 械构造的输出连杆17处的两个量：输出力矩τ和输出刚度K'。
[0064] 步骤4、控制模块可W利用给定输出力矩和刚度设计算法得到相应两根非线性弹 黃的伸缩量，进而控制输出。如图2所示，当产生较大力或者力矩的情况下，微处理器4能 立即作出相应的控制指令，起到保护驱动电机、关节和连杆的作用，为保证控制迅速准确， 微处理器采用PD控制。 W65] 微处理器可根据给定输出力矩τ和输出刚度Κ'计算得到两根非线性弹黃的伸 缩量和X2:
W側式（蝴和（14)中，X郝X2分别为第一根非线性弹黃15和第二根非线性弹黃16 的伸缩量，K'为给定输出刚度，R为转杆17自身的半径，τ为转杆17处的输出力矩；a,b， c分别表不：
[0069]a= 3Rk， （巧）
[0070] b= 2RkL+3R2τk/K'， (16)
[0071]c=R'TkL/K' +αΛτ2/^(κ' )2-Κ'， (17) 阳0巧式（15)，（16)和（17)中，a,b，c表不式（14)中的各未知量，R为转杆17自身的 半径，k为第一根非线性弹黃15与第二根非线性弹黃16的比例系数，L为第一根非线性弹 黃15和第二根非线性弹黃16的原长，K'为给定输出刚度，τ为转杆17处的输出力矩。
[0073] 如图4所示，微处理器就可W按照给定力矩和给定输出刚度，通过相应算法计算 和PD控制，及时准确地控制两根非线性弹黃的伸缩量，最终通过控制非线性弹黃伸缩量达 到输出可调节刚度，实现柔性控制，保护关节驱动器，提高人机交互的安全性。
[0074] 上述实施例为本发明较佳的实施方式，但本发明的实施方式并不受上述实施例的 限制，其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化， 均应为等效的置换方式，都包含在本发明的保护范围之内。
【主权项】
1. 一种基于非线性弹性元件的可调刚度驱动器，其特征在于，包括：控制电路、微处理 器、驱动电机、转轴、减速机构、非线性弹簧和齿轮蜗杆； 所述微处理器根据输出的刚度和力矩，计算出非线性弹簧的伸缩量，并控制驱动电 机； 所述驱动电机在微处理器的控制下，通过转轴输出产生的扭矩，经过减速机构降速同 时提高输出扭矩，经过齿轮蜗杆转换为拉力后，控制非线性弹簧的伸缩量，从而控制输出刚 度和力矩的变化。2. 如权利要求1所述的基于非线性弹性元件的可调刚度驱动器，其特征在于，所述控 制模块利用非线性弹簧伸缩量和输出力矩与刚度之间的关系，设计特定控制算法控制输出 刚度和力矩。3. 如权利要求1所述的基于非线性弹性元件的可调刚度驱动器，其特征在于，所述非 线性弹簧为的数量为两根，两根非线性弹簧分别在转杆两侧，并联的两根非线性弹簧连同 转杆整体的弹性系数正比于两根非线性弹簧的弹性系数之和；当关节驱动器在作用过程 中，所述非线性弹簧整体的弹性系数采用其输出力矩与时间转角的导数来表示，两根非线 性弹簧的输出力矩正比于两根非线性弹簧产生的弹力之差。4. 如权利要求3所述的基于非线性弹性元件的可调刚度驱动器，其特征在于，所述两 根非线性弹簧与相应位置的平方呈正相关。5. 如权利要求3所述的基于非线性弹性元件的可调刚度驱动器，其特征在于，所述两 根非线性弹簧均连着驱动电机，在控制模块的作用下，控制输出刚度的大小。6. 如权利要求3所述的基于非线性弹性元件的可调刚度驱动器，其特征在于，所述两 根非线性弹簧完全相同，所述两根非线性弹簧均通过连杆连接齿轮蜗杆，两根非线性弹簧 受驱动电机和微处理器的驱动与控制，连杆输出可调节的刚度大小以及力矩大小。7. -种驱动权利要求1所述的基于非线性弹性元件的可调刚度驱动器的驱动方法，其 特征在于，包括以下步骤： 步骤1、微处理器根据给定输出力矩和输出刚度计算得到两根非线性弹簧的伸缩量； 步骤2、微处理器通过ro控制将相应计算结果传给两个驱动电机，驱动电机输出相应 的力矩于各自转轴中； 步骤3、两个齿轮蜗杆分别将两个驱动电机输出的力矩转换为水平拉力，分别改变两根 非线性弹簧的伸缩量； 步骤4、驱动器通过两根非线性弹簧各自的伸缩量实时输出相应的可调刚度与力矩。
【专利摘要】本发明公开了一种基于非线性弹性元件的可调刚度驱动器，包括：控制电路、微处理器、驱动电机、转轴、减速机构、非线性弹簧和齿轮蜗杆；本发明还公开一种驱动基于非线性弹性元件的可调刚度驱动器的驱动方法，包括以下步骤：1、微处理器根据给定输出力矩和输出刚度计算得到两根非线性弹簧的伸缩量；2、微处理器通过PD控制将相应计算结果传给两个驱动电机，驱动电机输出相应的力矩于各自转轴中；3、两个齿轮蜗杆分别将两个驱动电机输出的力矩转换为水平拉力，分别改变两根非线性弹簧的伸缩量；4、驱动器通过两根非线性弹簧各自的伸缩量实时输出相应的可调刚度与力矩。具有简化了硬件装置和节省了空间等优点。
【IPC分类】B25J9/10, B25J17/00
【公开号】CN105313117
【申请号】CN201510862809
【发明人】杨辰光, 王行健, 梁培栋, 李智军, 宋嵘
【申请人】华南理工大学
【公开日】2016年2月10日
【申请日】2015年11月30日