CN110722563A - 一种变刚度软体机器人的建模方法 - Google Patents
一种变刚度软体机器人的建模方法 Download PDFInfo
- Publication number
- CN110722563A CN110722563A CN201911035773.2A CN201911035773A CN110722563A CN 110722563 A CN110722563 A CN 110722563A CN 201911035773 A CN201911035773 A CN 201911035773A CN 110722563 A CN110722563 A CN 110722563A
- Authority
- CN
- China
- Prior art keywords
- film tube
- thin film
- particles
- soft robot
- rigidity
- 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.)
- Pending
Links
Images
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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
-
- 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/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种变刚度软体机器人的建模方法,步骤1,填充颗粒间的锁紧力设计;步骤2,薄膜管内等效压强计算;步骤3,建立锁紧力与薄膜管内真空压力的对应关系;步骤4,颗粒块的锁紧力矩设计;步骤5,建立锁紧力矩与小球颗粒硬度的对应关系;步骤6,薄膜管变形角的计算。本发明将薄膜管内的所有填充颗粒和薄膜管,当作为一个整体的颗粒块,并将小球颗粒等效成流体,薄膜管等效为一个密闭空间,建立球体‑平面赫兹接触模型,根据赫兹接触理论和两圆球赫兹接触模型,建立锁紧力和锁紧力矩的模型,从而能控制变刚度软体机器人的刚度。本发明建立的模型,通过变刚度特性仿真,仿真所得结果与模型保持一致,因而可靠度高,便于推广利用。
Description
技术领域
本发明涉及驱动行进技术领域,特别是一种变刚度软体机器人的建模方法。
背景技术
根据软体驱动器的应用环境,需要机构具备较好的变刚度性能,即较好的柔顺性和刚性。在与物体接触前,需要有较好柔顺性,能通过主动变形实现自身运动,以较好的适应外界物体,获得更大的接触面积。与物体充分接触后,则需要具备较好的刚性,以提高物体接触间的压力,进而增大物体接触间的摩擦力。
同时,驱动器也需要其具备较好的位置控制性能,以较好的躲避障碍物。气动结构具有较好的位置控制性能,但由于其材料本身的特性,由其制成的机构刚度不高,而引入阻塞***则可增加软体机器人的刚度,以适应更多的应用场合。
气压驱动方式与其他物理驱动方式相比,具有响应速度快、功率密度高、开关速度高等特点。同时,由于构成软体机器人的材料通常具有良好的柔性,气压驱动时压力始终维持在较低的水平上,既能够使软体机器人实现相应的运动,同时又具有较高的安全性。
变刚度是软体结构(自然或人造)与环境相互作用的有效方式。软体结构固有的柔软性使自身发生变形以适应外界环境,安全的相互作用防止外界环境对实体的损害。但同时,也需要加强自身刚度以增加施加到外界环境的力。
基于颗粒堵塞的变刚度方法是一种利用真空压力控制刚度较有效的方法。颗粒阻塞是使大量的颗粒发生相变,在流体状态与固态之间进行转变。若在常态下将颗粒置于密封薄膜中,由于颗粒之间具有较大的空隙,颗粒之间的摩擦力较小,则其可以任意流动,因此表现出类流体行为,此时包裹大量颗粒的密封薄膜可产生任意形状的变化。当密封薄膜中的空气被排出后,大量的颗粒被压缩在一起,此时由于颗粒之间的接触面压力增大,使得颗粒间的摩擦力急剧上升,此时颗粒被限制住,不能随意流动,从而使填充颗粒呈现固态,密封薄膜和颗粒整体表现出一定的刚度。
申请人于2017年8月31日申请的申请号为CN201710768485.2的发明专利申请,其发明创造名称为“基于堵塞机理的变刚度软体驱动器、软体手臂和软体平台”,在该专利中,申请人公开了一种主要由柔性骨架、气管、外柔性层、堵塞机构、形变堵头和堵塞堵头组成的基于堵塞机理的变刚度软体驱动器,堵塞机构主要通过支撑骨架、弹性连接绳索、大球颗粒、小球颗粒、收紧弹簧和密封薄膜组成,其通过变刚度原理,既能具有较大柔性,又能具有较大刚性。
当前的软体驱动器由于采用软体材料制成,材料本征非线性明显,建模和控制困难,离人们期望的性能(与生物肌肉相媲美),还需要进一步进行探索和实践。因而,建模技术是本领域的难点。软体驱动器建模技术目前并不成熟,这也制约了软体机器人的发展和应用。
发明内容
本发明要解决的技术问题是针对上述现有技术的不足,而提供一种变刚度软体机器人的建模方法,该变刚度软体机器人的建模方法将薄膜管内的所有填充颗粒和薄膜管,当作为一个整体的颗粒块,并将小球颗粒等效成流体,薄膜管等效为一个密闭空间,建立球体-平面赫兹接触模型,根据赫兹接触理论和两圆球赫兹接触模型,建立锁紧力和锁紧力矩的模型,从而能根据需要控制变刚度软体机器人的刚度。
为解决上述技术问题,本发明采用的技术方案是:
一种变刚度软体机器人的建模方法,包括如下步骤。
步骤1,填充颗粒间的锁紧力FL设计,包括如下步骤。
步骤11,支撑骨架选择。堵塞机构中的支撑骨架选择为菱形骨架,密封薄膜选择为薄膜管。薄膜管中的大球颗粒和小球颗粒均统称为填充颗粒。
步骤12,建立颗粒块模型。为分析填充颗粒对变刚度软体机器人刚度的影响,在真空压力作用下,假定薄膜管内的所有填充颗粒都是刚性的,且被限制为一个整体,也即将薄膜管内的所有填充颗粒和薄膜管,当作为一个整体的颗粒块。
步骤13,填充颗粒间的锁紧力FL设计。当颗粒块受到外力时,将填充颗粒中的小球颗粒等效成流体,根据静力平衡方程和帕斯卡定律,得到填充颗粒间锁紧力FL的计算公式如下。
其中,P′为薄膜管内等效压强,R1为菱形骨架半径,α为菱形骨架的锐形顶角,R2为大球颗粒半径,μ1为小球颗粒与菱形骨架之间的摩擦系数,μ2为小球颗粒与大球颗粒之间的摩擦系数。
步骤2,薄膜管内等效压强P′计算。自然状态下,小球颗粒半径远小于薄膜管半径,单个小球颗粒正对着的薄膜管区域面积较小,因而,能将与单个小球颗粒接触的薄膜管近似看成是一块平面,建立球体-平面赫兹接触模型,根据赫兹接触理论和两圆球赫兹接触模型,得到薄膜管内等效压强P′的计算公式如下。
其中,R3为小球颗粒半径,v1为菱形骨架的泊松比,v2为小球颗粒的泊松比,E1为菱形骨架杨氏模量,E2为小球颗粒的杨氏模量,P为薄膜管内的真空压力。
步骤3,建立锁紧力FL与薄膜管内真空压力P的对应关系。将步骤2中计算的薄膜管内等效压强P′代入步骤1设计的锁紧力FL中,得到如下式所示的锁紧力FL与薄膜管内真空压力P的对应关系。
步骤4,颗粒块的锁紧力矩ML设计,设计公式如下所示。
其中,d为薄膜管半径。
还包括步骤5,建立锁紧力矩ML与小球颗粒硬度S1的对应关系。根据杨氏模量值与肖氏硬度值的对应关系,建立锁紧力矩ML与小球颗粒硬度S1的对应关系如下。
通过调整小球颗粒的硬度S1,进而调整变刚度软体机器人的刚度。小球颗粒的硬度S1越大,变刚度软体机器人的刚度越大。
还包括步骤6,薄膜管变形角β的设计。颗粒块受到外力时,薄膜管将与小球颗粒发生接触变形,则薄膜管的变形角β采用如下公式进行计算得出。
薄膜管变形角β的计算方法,包括如下步骤。
步骤61,薄膜管的相对径向形变位移δ的计算。根据步骤2中建立的球体-平面赫兹接触模型,再根据赫兹接触理论和两圆球赫兹接触模型,得到薄膜管的相对径向形变位移δ满足如下计算公式。
步骤62,建立薄膜管变形角β与薄膜管相对径向形变位移δ的对应关系。根据球体-平面赫兹接触模型,计算得出薄膜管变形角β与薄膜管相对径向形变位移δ的对应关系如下。
步骤63,薄膜管变形角β的计算。将步骤61中计算得到的薄膜管相对径向形变位移δ代入步骤62中,得出薄膜管变形角β满足如下公式。
步骤13中,根据静力平衡方程和帕斯卡定律,计算填充颗粒间锁紧力FL的方法,包括如下步骤。
步骤13a,锁紧力描述。颗粒块包括上层颗粒块和下层颗粒块,其中,下层颗粒块位于待锁紧物体一侧且底部与待锁紧物体相接触,上层颗粒则位于背离待锁紧物体的一侧。当颗粒块受到外力时,下层颗粒块的锁紧力需抵抗外力矩,因而,上层颗粒块和下层颗粒块沿水平方向发生相对滑动,根据颗粒块的静力平衡方程,则锁紧力FL描述为。
FL=2fU+fp+fL
其中,fL是颗粒块在与菱形骨架接触区域上的摩擦力,fP是颗粒块在锁紧区域上的静态力,fU是下层颗粒块与大球颗粒在水平方向上的摩擦力。
步骤13b,fP计算。将小球颗粒等效成流体,薄膜管等效为一个密闭空间,密闭空间内填充若干小球颗粒,从而构成一个静态流体模型,则颗粒块作用在锁紧区域水平方向上的静态力fP,将由颗粒块与菱形骨架间的压力提供,具体为。
fP=πR1 2P′sinα
其中,R1为菱形骨架半径,α为菱形骨架顶角,P′为薄膜管内等效压强。
步骤13c,fL计算。颗粒块在与菱形骨架接触区域上的摩擦力fL为。
fL=πR1 2P′μ1
其中,μ1为颗粒块与菱形骨架之间的摩擦系数。
步骤13d,fU计算。下层颗粒块与大球颗粒在水平方向上的摩擦力fU为。
其中,μ2为小球颗粒与大球颗粒之间的摩擦系数。
步骤13e,将步骤13b、13c和13d计算的fP、fL和fU,分别代入步骤13a中,即得到填充颗粒间锁紧力FL的计算公式。
通过真空泵调整薄膜管内的真空压力P,进而调整变刚度软体机器人的刚度。当薄膜管内的真空压力P增大时,薄膜管的变形角β和锁紧力矩ML均将增大,变刚度软体机器人的刚度增大。
通过调整小球颗粒半径R3,进而调整变刚度软体机器人的刚度。当小球颗粒半径R3越大,锁紧力矩ML越小,变刚度软体机器人的刚度将减小。
通过调整菱形骨架半径R1,进而调整变刚度软体机器人的刚度。当菱形骨架半径R1越大,锁紧力矩ML越大,变刚度软体机器人的刚度将增大。
通过调大球颗粒半径R2,进而调整变刚度软体机器人的刚度。当大球颗粒半径R2越大,锁紧力矩ML越大,变刚度软体机器人的刚度将增大。
本发明具有如下有益效果:将颗粒快分为上、下两层,下层颗粒块的锁紧力抵抗外力矩,当末端受到外力时,上、下两层颗粒块沿水平方向发生相对滑动,将小球颗粒等效成流体,薄膜管等效为一个密闭空间,其内部被小球颗粒这一流体填满,根据颗粒块的静力平衡方程得到锁紧力,单个颗粒正对着的薄膜区域面积较小,看成是一块平面,则利用赫兹接触理论对薄膜和颗粒块进行分析,建立球体-平面赫兹接触模型,得出小球颗粒硬度与锁紧力矩的关系。通过调整菱形骨架的顶角、半径,大球颗粒的半径,小球颗粒的半径、硬度,真空压力等参数,即可得到所需要的变刚度软体机器人的刚度。本发明建立的模型,通过变刚度特性仿真,仿真所得结果与建立的模型保持一致,因而可靠度高,便于推广利用。
附图说明
图1显示了本发明一种变刚度软体机器人中堵塞机构的结构示意图。
图2显示了本发明一种变刚度软体机器人中堵塞机构的纵剖面图。
图3显示了本发明一种变刚度软体机器人中堵塞机构末端受力的***分析图。
图4显示了同一收紧弹簧连接的所有大球颗粒所在纵向平面的剖面图。
图5显示了下层颗粒块受力分析示意图。
图6显示了流体加压模型示意图。
图7显示了本发明中堵塞机构的受力分析示意图。
图8显示了两圆球接触赫兹模型。
图9显示了小球颗粒与薄膜管接触的颗粒与平面赫兹接触模型。
图10显示了图9的简化模型图。
图11显示了变形角β与真空压力P的对应关系。
图12显示了锁紧力矩ML与真空压力P的对应关系。
图13显示了锁紧力矩ML与小球颗粒半径R3的对应关系。
图14显示了锁紧力矩ML与菱形骨架半径R1的对应关系。
图15显示了锁紧力矩ML与大球颗粒半径R2的对应关系。
图16显示了锁紧力矩ML与小球颗粒硬度S1的对应关系。
其中有:
10.接触区域;20.末端菱形骨架;21.径向大圆;
31.薄膜管;31a.薄膜管变形前;31b.薄膜管变形后;32.菱形骨架;33.柔性绳索;34.大球颗粒;35.小球颗粒;
40.真空泵;
51.上层颗粒块;52.下层颗粒块;
60.锁紧区域。
具体实施方式
下面结合附图和具体较佳实施方式对本发明作进一步详细的说明。
本发明的描述中,需要理解的是,术语“左侧”、“右侧”、“上部”、“下部”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,“第一”、“第二”等并不表示零部件的重要程度,因此不能理解为对本发明的限制。本实施例中采用的具体尺寸只是为了举例说明技术方案,并不限制本发明的保护范围。
一种变刚度软体机器人,其结构具体参见2017年8月31日申请的申请号为CN201710768485.2的发明专利申请,其发明创造名称为“基于堵塞机理的变刚度软体驱动器、软体手臂和软体平台”,本申请未对堵塞机构结构本身进行改进,只是将堵塞机构中的支撑骨架选择为菱形骨架32,密封薄膜选择为薄膜管31。薄膜管中的大球颗粒34和小球颗粒35均统称为填充颗粒,弹性连接绳索选择为柔性绳索33,通过真空泵40向薄膜管内提供真空压力,具体结构如图1和图2所示。
一种变刚度软体机器人的建模方法,包括如下步骤。
步骤1,填充颗粒间的锁紧力FL设计,包括如下步骤。
步骤11,支撑骨架选择。
步骤12,建立颗粒块模型。为分析填充颗粒对变刚度软体机器人刚度的影响,在真空压力作用下,假定薄膜管内的所有填充颗粒都是刚性的,且被限制为一个整体,也即将薄膜管内的所有填充颗粒和薄膜管,当作为一个整体的颗粒块。
步骤13,填充颗粒间的锁紧力FL设计。
当颗粒块受到外力时,将填充颗粒中的小球颗粒等效成流体,根据静力平衡方程和帕斯卡定律,得到填充颗粒间锁紧力FL的计算公式如下。
其中,P′为薄膜管内等效压强,R1为菱形骨架半径,α为菱形骨架的锐形顶角,R2为大球颗粒半径,μ1为小球颗粒与菱形骨架之间的摩擦系数,μ2为小球颗粒与大球颗粒之间的摩擦系数。
上述根据静力平衡方程和帕斯卡定律,计算填充颗粒间锁紧力FL的方法,包括如下步骤。
步骤13a,锁紧力描述。颗粒块包括上层颗粒块51和下层颗粒块52,其中,下层颗粒块位于待锁紧物体一侧且底部与待锁紧物体相接触,上层颗粒则位于背离待锁紧物体的一侧。如图3、图4和图5所示,当颗粒块受到外力FE时,下层颗粒块的锁紧力需抵抗外力矩,因而,上层颗粒块和下层颗粒块沿水平方向发生相对滑动,根据颗粒块的静力平衡方程,则锁紧力FL描述为。
FL=2fU+fp+fL
其中,fL是颗粒块在与菱形骨架接触区域10上的摩擦力,fP是颗粒块在锁紧区域60上的静态力,fU是下层颗粒块与大球颗粒在水平方向上的摩擦力。
步骤13b,fP计算。
颗粒块在锁紧区域上的静态力fP,可通过流体加压模型来估算。根据帕斯卡定律,密闭空间内的流体,施加到流体上压强,能够大小不变的由流体向空间各个方向传递。根据图6和帕斯卡定律,我们可得出:
图6中,密闭空间上表面和下表面面积相等,均为A2,Fext相当于步骤13a中颗粒块受到的外力FE。
所以,施加在图6区域A1上的力为:
将小球颗粒等效成流体,薄膜管等效为一个密闭空间,其内部被小球颗粒这一流体填满,则构成了一个如图7所示的静态流体模型,施加在每一面的力可以通过上式来计算。
则,颗粒块在锁紧区域A3上的静态力fP:
fP=FN2sinα=P′A3sinα=πR1 2P′sinα
其中,FN2为颗粒块对菱形骨架的正压力,如图7所示,R1为菱形骨架半径,α为菱形骨架顶角,P'为颗粒块施加给菱形骨架和大球的等效压强,也即为薄膜管内等效压强。
上述菱形骨架半径R1,是指图3中菱形骨架中径向大圆所在直径面中的半径,无限接近薄膜管半径d,可以近似相等。菱形骨架顶角α,是指位于柔性绳索上的顶角,为锐角。
步骤13c,fL计算:颗粒块在与菱形骨架接触区域上的摩擦力fL为:
fL=μ1P′·A1=πR1 2P′μ1
其中μ1为颗粒块与菱形骨架之间的摩擦系数,A1为颗粒块与菱形骨架接触区域的等效面积。
步骤13d,fU计算:下层颗粒块与大球颗粒在水平方向上的摩擦力fU为:
其中FN1为颗粒块对大球颗粒的正压力,R2为大球颗粒半径,μ2为小球颗粒(填充颗粒)与大球颗粒之间的摩擦系数,A2为颗粒块与大球颗粒接触的等效面积。
步骤13e,将步骤13b、13c和13d计算的fP、fL和fU,分别代入步骤13a中,即得到填充颗粒间锁紧力FL的计算公式。
步骤2,薄膜管内等效压强P′计算。
根据赫兹接触理论和图8所示的两圆球赫兹接触模型,则两球体相接触后,其中心相对变形位移和应力分别为:
其中,Ra为图8中a球半径,Rb为b球半径,va为a球泊松比,vb为b球泊松比,Ea为a球杨氏模量,Eb为b球杨氏模量。
自然状态下,小球颗粒半径远小于薄膜管半径,单个小球颗粒正对着的薄膜管区域面积较小,因而,能将与单个小球颗粒接触的薄膜管近似看成是一块平面,利用赫兹接触模型对薄膜管和颗粒块进行分析,建立球体-平面赫兹接触模型,令上述公式中的的Ra=∞,Rb=R3,并将薄膜管和小球颗粒的参数代入,得到薄膜管内等效压强P′的计算公式如下:
其中,δ薄膜管的相对径向形变位移,R3为小球颗粒半径,v1为菱形骨架的泊松比,v2为小球颗粒的泊松比,E1为菱形骨架杨氏模量,E2为小球颗粒的杨氏模量,P为薄膜管内的真空压力。
步骤3,建立锁紧力FL与薄膜管内真空压力P的对应关系。将步骤2中计算的薄膜管内等效压强P′代入步骤1设计的锁紧力FL中,得到如下式所示的锁紧力FL与薄膜管内真空压力P的对应关系。
步骤4,颗粒块的锁紧力矩ML设计,设计公式如下所示。
其中,d为薄膜管半径。
当真空压力P取极限真空度Pm=101kPa,并将数值代入上式中,则得到最大锁紧力矩MLm=304.5N.mm。
步骤5,建立锁紧力矩ML与小球颗粒硬度S1的对应关系。
基于经典线弹性理论,A.N.Gent提出杨氏模量值E与肖氏硬度值S的关系,为:
其中E为以MPa为单位的杨氏模量,S是以ASTM D2240标准的硬度计示数。该公式适用于硬度为20到80的物质,与小球颗粒的物质属性想接近。
根据上述杨氏模量值与肖氏硬度值的对应关系,建立锁紧力矩ML与小球颗粒硬度S1的对应关系如下。
通过调整小球颗粒的硬度S1,进而调整变刚度软体机器人的刚度。小球颗粒的硬度S1越大,变刚度软体机器人的刚度越大。
步骤6,薄膜管变形角β的设计。
颗粒块受到外力时,薄膜管将与小球颗粒发生接触变形,则薄膜管的变形角β采用如下公式进行计算得出。
薄膜管变形角β的计算方法,包括如下步骤。
步骤61,薄膜管的相对径向形变位移δ的计算。根据步骤2中建立的球体-平面赫兹接触模型,再根据赫兹接触理论和两圆球赫兹接触模型,得到薄膜管的相对径向形变位移δ满足如下计算公式。
本发明中,在步骤2,已能得出上述计算公式,此处仅为引用。
步骤62,建立薄膜管变形角β与薄膜管相对径向形变位移δ的对应关系。
根据如9所示的球体-平面赫兹接触模型及如图10所示的简化模型,由等腰∠ABC、∠AEC和直角∠ADC、∠EDC的性质,可得出以下关系:
∠ABC=2∠DAC=∠β
上述三式联立,计算得出薄膜管变形角β与薄膜管相对径向形变位移δ的对应关系如下:
步骤63,薄膜管变形角β的计算。将步骤61中计算得到的薄膜管相对径向形变位移δ代入步骤62中,得出薄膜管变形角β满足如下公式。
变刚度特性仿真:
利用步骤6设计的薄膜管变形角β,将机构的参数设置为:菱形骨架半径R1=14mm,大球颗粒半径R2=6.5mm,填充颗粒半径R3=3mm,得到了图11所示的薄膜变形角β与真空压力P之间的关系。从图中可看出,真空压力P越大,薄膜变形角β也越大。同时,随着压力逐渐增大,压力增量相同时,薄膜变形角的增量不断减小。
根据步骤3中建立的锁紧力FL与薄膜管内真空压力P对应关系,将参数设置为:R1=14mm,R2=6.5mm,R3=3mm,P=80kPa,薄膜管半径d=16mm。得到如图12所示的锁紧力矩ML和真空压力P之间的关系。从图中可见,真空压力P越大,锁紧力矩ML越大。因此,可通过调整真空压力来控制机构刚度。
根据步骤4设计的颗粒块的锁紧力矩ML,将机构的参数设置为:R1=14mm,R2=6.5mm,P=80kPa,d=16mm,并将R3范围设置在2mm~6mm之间。得到图13所示锁紧力矩ML与小球颗粒半径R3之间的关系。从图中可知,小球颗粒半径R3越大,锁紧力矩ML越小。且随着小颗粒尺寸的减小,相同尺寸减量下,锁紧力矩ML的减量越来越小。
根据步骤4设计的颗粒块的锁紧力矩ML,将机构的参数设置为:R2=6.5mm,R3=3mm,d=16mm,P=80kPa,并将菱形骨架半径R1范围设置在10mm~15mm之间。得到图14所示锁紧力矩ML与菱形骨架R1之间的关系。从图中可知,菱形骨架的半径R1越大,锁紧力矩ML越大。
根据步骤4设计的颗粒块的锁紧力矩ML,将机构的参数设置为:R1=14mm,R3=3mm,d=16mm,P=80kPa,并将大球颗粒半径R2设置为3mm~7mm之间。可得图15所示锁紧力矩ML与大球颗粒半径尺寸R2之间的关系。可见大球颗粒半径尺寸越大,锁紧力矩ML越大。且随着大球颗粒半径的增大,相同尺寸增量下,锁紧力矩ML的增量越来越大。
根据步骤4设计的颗粒块的锁紧力矩ML,将机构的参数设置为:R1=14mm,R2=6.5mm,R3=3mm,d=16mm,P=80kPa。然后得到图16所示锁紧力矩ML与颗粒硬度S1之间的关系。从图中可见,小颗粒硬度S1越大,锁紧力矩ML越大。且随着小颗粒硬度的增大,相同增量下,锁紧力矩ML的增量越来越小。
本发明首先从理论上对堵塞变刚度结构变刚度原理进行研究进行分析,先简化建模,并应用帕斯卡模型和赫兹接触理论,建立堵塞机构的力学模型,推导出机构末端的锁紧力矩与真空压力,小球颗粒硬度和大球颗粒半径之间的关系。得出机构刚度与真空度、菱形骨架半径和大球颗粒尺寸的关系,并进行仿真分析。便于后续驱动器空腔形状和壁厚尺寸的设计,以便具备更好的弯曲性能,更符合设计要求。
以上详细描述了本发明的优选实施方式,但是,本发明并不限于上述实施方式中的具体细节,在本发明的技术构思范围内,可以对本发明的技术方案进行多种等同变换,这些等同变换均属于本发明的保护范围。
Claims (10)
1.一种变刚度软体机器人的建模方法,其特征在于:包括如下步骤:
步骤1,填充颗粒间的锁紧力FL设计,包括如下步骤:
步骤11,支撑骨架选择:堵塞机构中的支撑骨架选择为菱形骨架,密封薄膜选择为薄膜管;薄膜管中的大球颗粒和小球颗粒均统称为填充颗粒;
步骤12,建立颗粒块模型:为分析填充颗粒对变刚度软体机器人刚度的影响,在真空压力作用下,假定薄膜管内的所有填充颗粒都是刚性的,且被限制为一个整体,也即将薄膜管内的所有填充颗粒和薄膜管,当作为一个整体的颗粒块;
步骤13,填充颗粒间的锁紧力FL设计:当颗粒块受到外力时,将填充颗粒中的小球颗粒等效成流体,根据静力平衡方程和帕斯卡定律,得到填充颗粒间锁紧力FL的计算公式如下:
其中,P′为薄膜管内等效压强,R1为菱形骨架半径,α为菱形骨架的锐形顶角,R2为大球颗粒半径,μ1为小球颗粒与菱形骨架之间的摩擦系数,μ2为小球颗粒与大球颗粒之间的摩擦系数;
步骤2,薄膜管内等效压强P′计算:自然状态下,小球颗粒半径远小于薄膜管半径,单个小球颗粒正对着的薄膜管区域面积较小,因而,能将与单个小球颗粒接触的薄膜管近似看成是一块平面,建立球体-平面赫兹接触模型,根据赫兹接触理论和两圆球赫兹接触模型,得到薄膜管内等效压强P′的计算公式如下:
其中,R3为小球颗粒半径,v1为菱形骨架的泊松比,v2为小球颗粒的泊松比,E1为菱形骨架杨氏模量,E2为小球颗粒的杨氏模量,P为薄膜管内的真空压力;
步骤3,建立锁紧力FL与薄膜管内真空压力P的对应关系:将步骤2中计算的薄膜管内等效压强P′代入步骤1设计的锁紧力FL中,得到如下式所示的锁紧力FL与薄膜管内真空压力P的对应关系:
步骤4,颗粒块的锁紧力矩ML设计,设计公式如下所示:
其中,d为薄膜管半径。
2.根据权利要求1所述的变刚度软体机器人的建模方法,其特征在于:还包括步骤5,建立锁紧力矩ML与小球颗粒硬度S1的对应关系:根据杨氏模量值与肖氏硬度值的对应关系,建立锁紧力矩ML与小球颗粒硬度S1的对应关系如下:
3.根据权利要求2所述的变刚度软体机器人的建模方法,其特征在于:通过调整小球颗粒的硬度S1,进而调整变刚度软体机器人的刚度;小球颗粒的硬度S1越大,变刚度软体机器人的刚度越大。
6.根据权利要求1所述的变刚度软体机器人的建模方法,其特征在于:步骤13中,根据静力平衡方程和帕斯卡定律,计算填充颗粒间锁紧力FL的方法,包括如下步骤:
步骤13a,锁紧力描述:颗粒块包括上层颗粒块和下层颗粒块,其中,下层颗粒块位于待锁紧物体一侧且底部与待锁紧物体相接触,上层颗粒则位于背离待锁紧物体的一侧;当颗粒块受到外力时,下层颗粒块的锁紧力需抵抗外力矩,因而,上层颗粒块和下层颗粒块沿水平方向发生相对滑动,根据颗粒块的静力平衡方程,则锁紧力FL描述为:
FL=2fU+fp+fL
其中,fL是颗粒块在与菱形骨架接触区域上的摩擦力,fP是颗粒块在锁紧区域上的静态力,fU是下层颗粒块与大球颗粒在水平方向上的摩擦力;
步骤13b,fP计算:将小球颗粒等效成流体,薄膜管等效为一个密闭空间,密闭空间内填充若干小球颗粒,从而构成一个静态流体模型,则颗粒块作用在锁紧区域水平方向上的静态力fP,将由颗粒块与菱形骨架间的压力提供,具体为:
fP=πR1 2P′sinα
其中,R1为菱形骨架半径,α为菱形骨架顶角,P′为薄膜管内等效压强;
步骤13c,fL计算:颗粒块在与菱形骨架接触区域上的摩擦力fL为:
fL=πR1 2P′μ1
其中,μ1为颗粒块与菱形骨架之间的摩擦系数;
步骤13d,fU计算:下层颗粒块与大球颗粒在水平方向上的摩擦力fU为:
其中,μ2为小球颗粒与大球颗粒之间的摩擦系数;
步骤13e,将步骤13b、13c和13d计算的fP、fL和fU,分别代入步骤13a中,即得到填充颗粒间锁紧力FL的计算公式。
7.根据权利要求5所述的变刚度软体机器人的建模方法,其特征在于:通过真空泵调整薄膜管内的真空压力P,进而调整变刚度软体机器人的刚度;当薄膜管内的真空压力P增大时,薄膜管的变形角β和锁紧力矩ML均将增大,变刚度软体机器人的刚度增大。
8.根据权利要求5所述的变刚度软体机器人的建模方法,其特征在于:通过调整小球颗粒半径R3,进而调整变刚度软体机器人的刚度;当小球颗粒半径R3越大,锁紧力矩ML越小,变刚度软体机器人的刚度将减小。
9.根据权利要求5所述的变刚度软体机器人的建模方法,其特征在于:通过调整菱形骨架半径R1,进而调整变刚度软体机器人的刚度;当菱形骨架半径R1越大,锁紧力矩ML越大,变刚度软体机器人的刚度将增大。
10.根据权利要求5所述的变刚度软体机器人的建模方法,其特征在于:通过调大球颗粒半径R2,进而调整变刚度软体机器人的刚度;当大球颗粒半径R2越大,锁紧力矩ML越大,变刚度软体机器人的刚度将增大。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911035773.2A CN110722563A (zh) | 2019-10-29 | 2019-10-29 | 一种变刚度软体机器人的建模方法 |
PCT/CN2020/100791 WO2021082520A1 (zh) | 2019-10-29 | 2020-07-08 | 一种变刚度软体机器人的建模方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911035773.2A CN110722563A (zh) | 2019-10-29 | 2019-10-29 | 一种变刚度软体机器人的建模方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110722563A true CN110722563A (zh) | 2020-01-24 |
Family
ID=69222357
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911035773.2A Pending CN110722563A (zh) | 2019-10-29 | 2019-10-29 | 一种变刚度软体机器人的建模方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN110722563A (zh) |
WO (1) | WO2021082520A1 (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021082520A1 (zh) * | 2019-10-29 | 2021-05-06 | 南京南邮信息产业技术研究院有限公司 | 一种变刚度软体机器人的建模方法 |
CN113319889A (zh) * | 2021-06-15 | 2021-08-31 | 西北工业大学 | 用于强化软体刚度的填充颗粒及系列化的应用 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5742145A (en) * | 1994-09-07 | 1998-04-21 | Polytechnic University | Apparatus for reducing vibration inputs to a device and/or for positioning the device |
CN104227721A (zh) * | 2014-08-18 | 2014-12-24 | 浙江工业大学 | 仿生软体机器人的可变刚度模块 |
US20150360367A1 (en) * | 2013-02-08 | 2015-12-17 | Inria Institut National De Recherche En Informatique Et En Automatique | Method for Controlling a Deformable Robot, and Related Module and Computer Program |
CN107756385A (zh) * | 2017-08-31 | 2018-03-06 | 南京邮电大学 | 基于堵塞机理的变刚度软体驱动器、软体手臂和软体平台 |
CN108381548A (zh) * | 2018-05-03 | 2018-08-10 | 佛山伊贝尔科技有限公司 | 一种空心玻璃微珠组成的软体机器人 |
CN108527372A (zh) * | 2018-06-22 | 2018-09-14 | 中国科学技术大学 | 一种变刚度串联弹性驱动器的机器人关节自适应控制方法 |
CN109176500A (zh) * | 2018-10-26 | 2019-01-11 | 苏州工业园区新国大研究院 | 一种软体变刚度驱动装置 |
CN109702740A (zh) * | 2018-12-14 | 2019-05-03 | 中国科学院深圳先进技术研究院 | 机器人柔顺性控制方法、装置、设备及存储介质 |
CN110202574A (zh) * | 2019-06-05 | 2019-09-06 | 南京航空航天大学 | 基于环境刚度估计的机器人自适应混合阻抗/导纳控制方法 |
CN110293544A (zh) * | 2019-07-29 | 2019-10-01 | 中凯宝智能机器人科技(苏州)有限公司 | 变刚度软体蛇形臂的变形预测方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015006613A1 (en) * | 2013-07-10 | 2015-01-15 | Empire Robotics, Inc. | End effector, apparatus, system and method for gripping and releasing articles and the like |
CN207157327U (zh) * | 2017-08-31 | 2018-03-30 | 南京邮电大学 | 软体机器人 |
CN108481318B (zh) * | 2018-03-07 | 2021-07-06 | 河南工业大学 | 基于散粒体阻塞理论的变刚度驱动杆及其工作*** |
CN110722563A (zh) * | 2019-10-29 | 2020-01-24 | 南京南邮信息产业技术研究院有限公司 | 一种变刚度软体机器人的建模方法 |
-
2019
- 2019-10-29 CN CN201911035773.2A patent/CN110722563A/zh active Pending
-
2020
- 2020-07-08 WO PCT/CN2020/100791 patent/WO2021082520A1/zh active Application Filing
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5742145A (en) * | 1994-09-07 | 1998-04-21 | Polytechnic University | Apparatus for reducing vibration inputs to a device and/or for positioning the device |
US20150360367A1 (en) * | 2013-02-08 | 2015-12-17 | Inria Institut National De Recherche En Informatique Et En Automatique | Method for Controlling a Deformable Robot, and Related Module and Computer Program |
CN104227721A (zh) * | 2014-08-18 | 2014-12-24 | 浙江工业大学 | 仿生软体机器人的可变刚度模块 |
CN107756385A (zh) * | 2017-08-31 | 2018-03-06 | 南京邮电大学 | 基于堵塞机理的变刚度软体驱动器、软体手臂和软体平台 |
CN108381548A (zh) * | 2018-05-03 | 2018-08-10 | 佛山伊贝尔科技有限公司 | 一种空心玻璃微珠组成的软体机器人 |
CN108527372A (zh) * | 2018-06-22 | 2018-09-14 | 中国科学技术大学 | 一种变刚度串联弹性驱动器的机器人关节自适应控制方法 |
CN109176500A (zh) * | 2018-10-26 | 2019-01-11 | 苏州工业园区新国大研究院 | 一种软体变刚度驱动装置 |
CN109702740A (zh) * | 2018-12-14 | 2019-05-03 | 中国科学院深圳先进技术研究院 | 机器人柔顺性控制方法、装置、设备及存储介质 |
CN110202574A (zh) * | 2019-06-05 | 2019-09-06 | 南京航空航天大学 | 基于环境刚度估计的机器人自适应混合阻抗/导纳控制方法 |
CN110293544A (zh) * | 2019-07-29 | 2019-10-01 | 中凯宝智能机器人科技(苏州)有限公司 | 变刚度软体蛇形臂的变形预测方法 |
Non-Patent Citations (1)
Title |
---|
FENGYOU JIANG: ""Force Analysis and Experiment of Variable Stiffness Soft Actuator Based on Particle Jamming", 《SPRINGERLINK》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2021082520A1 (zh) * | 2019-10-29 | 2021-05-06 | 南京南邮信息产业技术研究院有限公司 | 一种变刚度软体机器人的建模方法 |
CN113319889A (zh) * | 2021-06-15 | 2021-08-31 | 西北工业大学 | 用于强化软体刚度的填充颗粒及系列化的应用 |
CN113319889B (zh) * | 2021-06-15 | 2024-02-23 | 西北工业大学 | 用于强化软体刚度的填充颗粒及系列化的应用 |
Also Published As
Publication number | Publication date |
---|---|
WO2021082520A1 (zh) | 2021-05-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110722563A (zh) | 一种变刚度软体机器人的建模方法 | |
CN109249385B (zh) | 一种基于颗粒阻塞的变刚度气动软体驱动器 | |
Drotman et al. | 3D printed soft actuators for a legged robot capable of navigating unstructured terrain | |
CN107756385B (zh) | 基于堵塞机理的变刚度软体驱动器、软体手臂和软体平台 | |
Steltz et al. | Jamming as an enabling technology for soft robotics | |
CN105798896B (zh) | 一种基于气压锁定原理的变刚度连续型机构 | |
Wei et al. | A soft robotic spine with tunable stiffness based on integrated ball joint and particle jamming | |
CN207155799U (zh) | 软体驱动器、软体手臂和软体平台 | |
Choi et al. | Tendon-driven jamming mechanism for configurable variable stiffness | |
CN101890988B (zh) | 一种机器人仿壁虎粘附脚趾及其运动方法 | |
CN110142760B (zh) | 一种软体攀爬机器人建模方法 | |
CN107457797A (zh) | 多孔双层流体自适应机器人手装置 | |
CN107834897B (zh) | 基于压电驱动的爬行作动器及其工作方法 | |
Sharp et al. | Scale-and load-dependent friction in commensurate sphere-on-flat contacts | |
Li et al. | A novel versatile robotic palm inspired by human hand | |
Chen et al. | A pneumatic–hydraulic hybrid actuator for underwater soft robot swimming and crawling | |
Su et al. | Design, mobility analysis and gait planning of a leech-like soft crawling robot with stretching and bending deformation | |
WO2019187171A1 (ja) | 移動ロボット | |
Park et al. | Compliant footpad design analysis for a bio-inspired quadruped amphibious robot | |
CN108674512B (zh) | 一种爬壁末端装置及包括该爬壁末端装置的爬壁机器人 | |
Gamba et al. | Balancing on a springy leg | |
US20240157576A1 (en) | Robotic End-Effector Having Dynamic Stiffening Elements with Resilient Spacers for Conforming Object Interaction | |
WATANABE et al. | Snail inspired climbing robot using fluid adhesion to travel on rough concrete walls and ceilings | |
Chen et al. | Design and modeling of a novel soft parallel robot driven by endoskeleton pneumatic artificial muscles | |
CN207189700U (zh) | 多孔双层流体自适应机器人手装置 |
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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200124 |