一种柔性机器手及其控制方法
【技术领域】
[0001]本发明涉及，更确切地说涉及一种柔性机器手及其控制方法。
【背景技术】
[0002]传统的刚体执行器通过其刚性结构和转矩(扭力)以及位置(力)传感器等进行控制，如机械手等，这些刚体执行器能够较好的应用于工业生产，如抓取装配流程和点焊工艺等。但是由于其一般刚体执行器由刚性结构组成，这就决定了该类机器手有限的操作性和适应性，在环境接触面不确定或者连续不可导之类环境中的运动能力有限，如运动自由度较低，且不能够改变自身形状和尺寸以使其不能很好适用于范围广泛的任务和环境。
【发明内容】
[0003]本发明要解决的技术问题是，提供一种结构简单，能改变结构以适应多种环境的柔性机器手及其控制方法。
[0004]本发明的技术解决方案是，提供一种柔性机器手，包括:
[0005]手状本体，所述的手状本体手指处包括若干执行主体，所述的执行主体包括弹性空腔，所述的弹性空腔设有限制弹性空腔径向膨胀的第一固定件以及限制弹性空腔一侧轴向膨胀的第二固定件；
[0006]驱动组件，所述的驱动组件与弹性空腔连接并控制弹性空腔内压力；
[0007]控制组件，所述的控制组件包括控制驱动组件的控制器、沿弹性空腔轴向设置的弯曲传感器、沿弹性空腔轴向间隔设置的惯性传感器，一端位于弹性空腔内的内压力传感器。
[0008]优选的，所述的执行主体包括两个相对设置的弹性空腔，所述的第二固定件设置于两个弹性空腔之间。
[0009]优选的，所述的执行主体包括若干沿执行主体周向排布的弹性空腔。
[0010]优选的，所述的弹性空腔横截面形状为扇形并包括弧形侧壁和矩形侧壁，所述的第二固定件设置于矩形侧壁上。
[0011]优选的，所述的驱动组件包括驱动弹性空腔内流体的栗体。
[0012]采用以上结构后，本发明的柔性机器手，与现有技术相比，具有以下优点:所述的手状本体手指处包括若干执行主体，所述的执行主体包括弹性空腔，所述的执行主体包括弹性空腔，所述的弹性空腔设有限制弹性空腔径向膨胀的第一固定件以及限制弹性空腔一侧轴向膨胀的第二固定件，在弹性空腔内压力发生变化时，由于第二固定件将弹性空腔一侧限制轴向膨胀，所以弹性空腔会发生弯曲或者由弯曲逐渐伸直，且由于弹性空腔可以发生形变，在执行主体抵触接触物时，执行主体能自身发生形变以适应接触物，并设置控制弹性空腔内压力的驱动组件，实现对弹性空腔内压力的增大或减小，控制手状本体进行抵触、抓取等动作，并通过控制组件精准检测控制，所述的控制组件包括控制驱动组件的控制器、沿弹性空腔轴向设置的弯曲传感器、沿弹性空腔轴向间隔设置的惯性传感器，一端位于弹性空腔内的气压传感器，所述的气压传感器可以实时准确反馈弹性空腔内压力，所述的惯性传感器可以实时反馈自身位置，通过各个惯性传感器自身位置能准确反应弹性空腔的空间位置，弯曲传感器能准确的反馈弹性空腔侧壁的弯曲程度，控制器接收气压传感器、惯性传感器、弯曲传感器信号并判断执行主体状况进行实时精确的控制，使柔性机器手能精准运行，且结构简单可靠。
[0013]本发明的技术解决方案是，还提供一种柔性机器手的控制方法，包括:
[0014]a、控制器接收弯曲角度X命令并识别执行主体原弯曲角度Y;
[0015]b、控制器对比弯曲角度X和原弯曲角度Y并控制驱动组件改变弹性空腔压力；
[0016]C、控制器实时接收惯性传感器发出的位置信号、弯曲传感器发出的弯曲角度信号以及气压传感器发出的气压信号；
[0017]d、控制器根据传感器信号变化值判断执行主体的弯曲角度并实现执行主体的弯曲角度为X。
[0018]优选的，所述的步骤d具体包括以下步骤:
[0019]dl、控制器根据实时位置信号、曲角度信号、气压信号分别得到实时弯曲角度Z1、Z2、Z3;
[0020](12、控制器判断实时弯曲角度21、22、23，
[0021 ]当Zl、Z2、Z3均按一定偏差η内的幅度变化时，控制器判断实时弯曲角度Zl为实时执行主体弯曲角度，
[0022]当Zl、Ζ2、Ζ3未按一定偏差η内的幅度变化时，控制器取Ζ2和Ζ3的计算值为实时执行主体弯曲角度；
[0023]d2、控制器根据实时执行主体弯曲角度控制弹性空腔压力使执行主体的弯曲角度为X。
[0024]优选的，所述的步骤d2中控制器取Z2和Z3的计算值为实时执行主体弯曲角度是指:控制器将Z2和Z3分别乘以不同的权重并相加得到实时执行主体弯曲角度，所述的权重通过气压传感器、弯曲传感器与执行主体实际弯曲角度模型计算得到。
[0025]优选的，所述的执行主体外表面设有检测执行主体所受外界压力的外压力传感器，当外压力传感器信号大于一定阈值与/或内压力传感器信号大于一定阈值，减小各弹性空腔压力并停止驱动组件运动。
[0026]优选的，所述的执行主体原弯曲角度Y通过控制器上一次记录的执行主体弯曲角度得到或通过弯曲传感器实时检测得到。
[0027]采用以上结构后，本发明的一种柔性机器手，与现有技术相比，具有以下优点:通过气压传感器可以实时准确反馈弹性空腔内压力，所述的惯性传感器可以实时反馈自身位置，通过各个惯性传感器自身位置能准确反应弹性空腔的空间位置，弯曲传感器能准确的反馈弹性空腔侧壁的弯曲程度，控制器实时接收气压传感器、惯性传感器、弯曲传感器信号并比较三者之间的变化值判断执行主体的实时弯曲角度，减少各种因素对自身判断的干扰，且避免了自身形变的干扰，能准确检测并准确控制。
【附图说明】
[0028]图1是本发明的一种柔性机器手的结构示意图。
[0029]图中所示:1、执行主体;2、控制组件;3、驱动组件。
【具体实施方式】
[0030]下面结合附图和具体实施例对本发明作进一步说明。
[0031]请参阅图1所示，本发明的一种柔性机器手，包括:手状本体、驱动组件3、控制组件2，所述的手状本体手指处包括若干执行主体I，所述的执行主体I包括弹性空腔，所述的弹性空腔设有限制弹性空腔径向膨胀的第一固定件以及限制弹性空腔一侧轴向膨胀的第二固定件，所述的驱动组件3与弹性空腔连接并控制弹性空腔内压力，所述的控制组件2包括控制驱动组件3的控制器、沿弹性空腔轴向设置的弯曲传感器、沿弹性空腔轴向间隔设置的惯性传感器，一端位于弹性空腔内的内压力传感器，所述的手状本体手指处包括若干执行主体I，所述的执行主体I包括弹性空腔，所述的执行主体I包括弹性空腔，所述的弹性空腔设有限制弹性空腔径向膨胀的第一固定件以及限制弹性空腔一侧轴向膨胀的第二固定件，在弹性空腔内压力发生变化时，由于第二固定件将弹性空腔一侧限制轴向膨胀，所以弹性空腔会发生弯曲或者由弯曲逐渐伸直，且由于弹性空腔可以发生形变，在执行主体I抵触接触物时，执行主体I能自身发生形变以适应接触物，并设置控制弹性空腔内压力的驱动组件3，实现对弹性空腔内压力的增大或减小，控制手状本体进行抵触、抓取等动作，并通过控制组件2精准检测控制，所述的控制组件2包括控制驱动组件3的控制器、沿弹性空腔轴向设置的弯曲传感器、沿弹性空腔轴向间隔设置的惯性传感器，一端位于弹性空腔内的气压传感器，所述的气压传感器可以实时准确反馈弹性空腔内压力，所述的惯性传感器可以实时反馈自身位置，通过各个惯性传感器自身位置能准确反应弹性空腔的空间位置，弯曲传感器能准确的反馈弹性空腔侧壁的弯曲程度，控制器接收气压传感器、惯性传感器、弯曲传感器信号并判断执行主体I状况进行实时精确的控制，使柔性机器手能精准运行，且结构简单可
A+-.与巨O
[0032]控制器具体控制如下，该控制器利用气压传感器采集弹性空腔内部压力值信号，并将该信号经过模/数转换器送给微控制器芯片，然后通过增量式PID算法控制进入腔体的气流量从而控制的姿态。整个装置的硬件平台主要由电源模块，控制电路，打气栗，电磁阀组，气压传感器、惯性传感器、弯曲传感器以及气管气动接头和外围电路组成。控制电路中主要由微控制器芯片，M0SFET模块和压力传送器模块组成的。电源模块由24V开关电源和降压模块组成，24V开关电源将220V交流电转化成24V直流电，降压模块将24V直流电转化成12V和3.3V的直流电供给装置工作。微控制器芯片产生PffM波信号输入到MOSFET管栅极从而驱动高频电磁阀的通断。由于PWM波的控制实质是利用面积等效原理，这就要求系统有足够高的可调频率，因此该系统中使用开关频率高达200Hz的电磁阀，阀门的开断时间为5ms，分别连接软体，打气栗，消声器作为排气孔。取PWM波频率为150Hz，通过调节PWM占空比，SP调节高频电磁阀的接通和断开时间，可以控制进气压力，通过气压传感器、惯性传感器、弯曲传感器信号反馈给微控制器芯片，微控制器芯片再改变方波的占空比(PWM)来控制电磁阀的通断时间来改变气压以达到设定的气压值。
[0033]所述的执行主体I包括两个相对设置的弹性空腔，所述的第二固定件设置于两个弹性空腔之间，所述的执行主体I包括若干沿执行主体I周向排布的弹性空腔，即