CN109095242B - 管线输送系统及其控制方法 - Google Patents
管线输送系统及其控制方法 Download PDFInfo
- Publication number
- CN109095242B CN109095242B CN201811009987.8A CN201811009987A CN109095242B CN 109095242 B CN109095242 B CN 109095242B CN 201811009987 A CN201811009987 A CN 201811009987A CN 109095242 B CN109095242 B CN 109095242B
- Authority
- CN
- China
- Prior art keywords
- pipeline
- following
- assembly
- motor
- position information
- 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.)
- Active
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65H—HANDLING THIN OR FILAMENTARY MATERIAL, e.g. SHEETS, WEBS, CABLES
- B65H20/00—Advancing webs
- B65H20/02—Advancing webs by friction roller
Landscapes
- Control Of Conveyors (AREA)
Abstract
本发明公开了一种管线输送系统及其控制方法,其中,管线输送系统包括:输送装置,输送装置相对地面固定设置;安装组件和跟随装置,跟随装置安装在安装组件上,跟随装置通过管线与输送装置相连;跟随电机和传动组件,跟随电机安装在传动组件上,跟随电机带动传动组件转动,传动组件与安装组件相连,以在传动组件转动时带动跟随装置运动。该管线输送系统,通过跟随电机驱动传动组件转动,以带动跟随装置运动,能够保证输送装置对管线进行稳定输送。
Description
技术领域
本发明涉及医疗器械技术领域,更具体地,涉及一种管线输送系统和一种管线输送系统的控制方法。
背景技术
目前,介入手术机器人包括输送机架和跟随机架。为了防止管线卷曲,也为了避免管线受阻而影响输送,输送机架和跟随机架在输送管线时,末端均需要对管线起支撑作用的装置。
一般而言,输送机架在整个机器的前端固定不动,跟随机架在整个机器的后端,跟随机架通过管线与输送机架连接,并可随着管线前后运动。当管线向前运动时,会拉拽后端的跟随机架向前运动,使管线张紧力变大。然而,如果仅靠拉拽的力保持跟随机架和输送机架的相对位置,不仅容易损坏管线,还会使得管线输送反应迟钝。
同样的,跟随机架的后端也需要一个支撑结构对管线进行引导,否则跟随机架的运动将会使管线过度拉拽或卷曲。
发明内容
本发明旨在至少在一定程度上解决相关技术中的技术问题之一。为此,本发明的一个目的在于提出一种管线输送系统,该系统能够保证输送装置对管线进行稳定输送。
本发明的第二个目的在于提出一种管线输送系统的控制方法。
为达到上述目的,本发明第一方面实施例提出了一种管线输送系统,包括:输送装置,所述输送装置相对地面固定设置;安装组件和跟随装置,所述跟随装置安装在所述安装组件上,所述跟随装置通过管线与所述输送装置相连;跟随电机和传动组件,所述跟随电机安装在所述传动组件上,所述跟随电机带动所述传动组件转动,所述传动组件与所述安装组件相连,以在所述传动组件转动时带动所述跟随装置运动。
本发明实施例的管线输送系统,通过跟随电机驱动传动组件转动,以带动跟随装置运动,能够保证输送装置对管线进行稳定输送。
本发明第二方面实施例提出了一种管线输送系统的控制方法,包括以下步骤:接收用户输入的管线输送指令;检测所述输送装置输送的管线的位置,以得到第二位置信息;根据所述管线输送指令和所述第二位置信息对管线进给电机和/或管线旋转电机进行控制,其中,所述管线进给电机和所述管线旋转电机与所述输送装置配合以驱动管线运动;检测所述跟随装置夹持的所述管线的位置,以得到第一位置信息,并根据所述第一位置信息对所述跟随电机进行控制。
根据本发明实施例的管线输送系统的控制方法,根据所述管线输送指令和所述第二位置信息对管线进给电机和/或管线旋转电机进行控制,并根据所述第一位置信息对所述跟随电机进行控制,以通过跟随电机驱动传动组件转动,从而带动跟随装置运动,能够保证输送装置对管线进行稳定输送。
本发明附加的方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
图1是根据本发明一个实施例的管线输送系统的结构示意图;
图2是根据本发明一个实施例的管线输送系统工作时的示意图;
图3是根据本发明一个实施例的跟随装置的示意图;
图4是根据本发明一个实施例的跟随装置的爆炸图;
图5是根据本发明一个实施例的连接套组件的爆炸图;
图6是根据本发明一个实施例的跟随装置的剖视图;
图7是根据本发明一个实施例的滑块上盖打开时跟随装置的示意图;
图8是根据本发明一个实施例的传感器组件的结构示意图;
图9是根据本发明一个实施例的输送装置的结构示意图;
图10是根据本发明一个实施例的驱动装置的结构示意图;
图11是根据本发明实施例的管线输送系统的控制方法的流程图。
附图标记:
管线输送系统100;
1跟随装置、2输送装置、3安装组件、4同步带、5主动带轮、6跟随电机、7从动带轮、8管线、9传送组件、10驱动装置、11基座、动力组件12、13管线位置激光传感器;
101连接套组件、102滑块上盖、103滑块座、104第一导向轴、105拨叉、106传感器组件、107底座、108固定板、109导向轴支架、110第一圆柱销、111第二导向轴、112第一直线轴承、113第二直线轴承、114第二圆柱销、115拉伸弹簧;
1011连接套、1012轴承、1013轴承、1014护套;
1021定位块、1031定位块;
1051第一触点、1052第二触点、1061第一微动开关、1062第二微动开关、1063霍尔传感器、1064磁铁;
201管线进给电机、202管线旋转电机。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
下面参考附图1-11描述本发明实施例的管线输送系统及其控制方法。
图1是本发明实施例的管线输送系统的结构示意图。如图1所示,管线输送系统100包括跟随装置1、输送装置2、安装组件3、跟随电机6和传送组件9。
其中,输送装置2相对地面固定设置;跟随装置1安装在安装组件3上,跟随装置1通过管线8与输送装置2相连;跟随电机6安装在传动组件9上,跟随电机6带动传动组件9转动,传动组件9与安装组件3相连,以在传动组件9转动时带动跟随装置1运动。
具体地,参见图1,管线8的尾端夹持在跟随装置1中,管线8的首端穿过输送装置2,并由输送装置2向人体输送。此时,可控制跟随电机6启动,以带动传动组件9转动,进而与传动组件9相连的安装组件3跟随传动组件9一起朝向输送装置2运动,同时安装在安装组件3上的跟随装置1向输送装置2运动,由此,可以保证管线8的稳定输送。具体操作过程中,所传输的管线8包括但不限于导管、导丝,还可以是其他任意管状物、线状物、丝状物等。
在本发明的一个实施例中,如图1、图2所示,传动组件9包括同步带4、主动带轮5、从动带轮7,其中,主动带轮5与跟随电机6相连,同步带4的两端分别套设在主动带轮5和从动带轮7上。具体地,跟随电机6驱动主动带轮5转动,以带动同步带4运动。
参见图2,当跟随装置1处于A位置时,输送装置2开始向右输送管线8,此时控制跟随电机6启动,开始带动同步带4顺时针转动,以使跟随装置1向右运动。当输送装置2完成管线8的输送后,跟随装置1运动到B位置,此时控制跟随电机6停止,以使跟随装置1停止在B位置。
可选地,传动组件9可以包括滑轨、滑轮、牵引件,其中,滑轮安装在安装组件3的底部,滑轮可沿滑轨滑动,牵引件的一端与安装组件3相连,牵引件的另一端与跟随电机6的转轴相连。由此,跟随电机6转动时,可通过牵引件带动安装组件3在滑轨滑动。
如图3-7所示,在一个实施例中,跟随装置1包括连接套组件101、滑块上盖102、滑块座103、第一导向轴104、底座107、固定板108、导向轴支架109、第一圆柱销110、第二导向轴111、第一直线轴承112、第二直线轴承113、第二圆柱销114和拉伸弹簧115。
其中,底座107安装在安装组件3上,固定板108安装在底座107上,导向轴支架109安装在固定板108上,第一导向轴104和第二导向轴111均安装在导向轴支架109上。滑块座103内限定有用于容纳连接套组件101的第一容纳腔,滑块座103与导向轴支架109之间通过拉伸弹簧115连接,其中,连接套组件101通过管线8与输送装置2相连,拉伸弹簧115的两端分别通过第一圆柱销110和第二圆柱销114固定。第一直线轴承112和第二直线轴承113均安装在滑块座103内,并分别对应安装在第一导向轴104与第二导向轴111上,其中,滑块座103在第一导向轴104与第二导向轴上111可移动。滑块上盖102与第一导向轴104和第二导向轴111可活动地相连以打开和关闭第一容纳腔。
具体地,参见图3、图4和图7,滑块上盖102的一端可安装在第一导向轴104上,并绕第一导向轴104可旋转,滑块上盖102另一端设有缺口,并可压紧安装在第二导向轴111上。
如图5所示,连接套组件101包括连接套1011、第一轴承1012、第二轴承1013和护套1014。
参见图5-7,连接套1011用于夹持管线8的尾端,第一轴承1012和第二轴承1013均安装在连接套1011上,护套1014内限定有用于容纳连接套1011、第一轴承1012和第二轴承1013的第二容纳腔,且连接套1011在第二容纳腔中可旋转,护套1014上设有第一定位孔1015和第二定位孔(图5-7中未示出),其中,滑块上盖102的定位块1021嵌入连接在第一定位孔1015中,滑块座103的定位块1031嵌入连接在第二定位孔中。
进一步地,如图3、图4、图7和图8所示,跟随装置1还包括拨叉105、传感器组件106和跟随电机控制器(图中未示出)。
其中,拨叉105安装在滑块座103的下端,且设置在底座107的一侧,拨叉105的下端悬空。传感器组件106安装在底座107上,且设置在拨叉105的下端,传感器组件106用于检测夹持在连接套1011中的管线8的位置,并生成第一位置信息。
在该实施例中,跟随电机控制器分别与传感器组件106和跟随电机6电连接,跟随电机控制器用于根据第一位置信息生成相应的控制指令,并根据控制指令对跟随电机6进行控制。
具体地,参见图8,传感器组件106包括第一微动开关1061和第二微动开关1062。其中,第一微动开关1061与拨叉105的第一触点1051对应设置,且当管线8的轴向力大于预紧力时,第一微动开关1061与第一触点1051接触,并生成第一触发信号;第二微动开关1062与拨叉105的第二触点1052对应设置,且当管线8的轴向力小于预紧力时,第二微动开关1062与第二触点1052接触,并生成第二触发信号。
可选地,第一微动开关1061、第一触点1051、第二微动开关1062和第二触点1052的连线为一条直线,且该直线与管线8的输送方向平行。其中,如果第一微动开关1061设置在靠近输送装置2的一端,则第二微动开关1062设置在远离输送装置2的一端;如果第二微动开关1062设置在靠近输送装置2的一端,则第一微动开关1061设置在远离输送装置2的一端。
在该实施例中,第一位置信息包括第一触发信息和第二触发信息,跟随电机控制器可根据第一触发信号控制跟随电机6以预设上限速度和第一方向转动,以及根据第二触发信号控制跟随电机6以预设上限速度和第二方向转动。
具体而言,管线8穿过连接套组件101,管线8尾端由连接套组件101中连接套1011夹持、限位;连接套组件101装入跟随装置1,如图7所示;将跟随装置1安装在安装组件3上,管线8前端由输送装置2输送。
当管线8做旋转运动时,连接套组件101中的连接套1011可以随管线8做同步旋转运动。
如果第一微动开关1061远离输送装置2的一端设置,则当管线8的轴向力大于预紧力时,拨叉105的第一触点1051与第一微动开关1061接触,如图8所示,跟随电机控制器得到第一触发信号,跟随电机控制器控制跟随电机6启动,驱动同步带4,使跟随装置1向输送装置2靠近;当拨叉105的第一触点1051与第一微动开关1061脱离接触,跟随电机控制器控制跟随电机6停止,跟随装置1停止运动,此时,管线8的轴向力与预紧力相同。
如果第一微动开关1061远离输送装置2的一端设置,则当管线8的轴向力小于预紧力时,在拉伸弹簧115的弹簧力的作用下拨叉105的第二触点1052与第二微动开关1062接触,跟随电机控制器得到第二触发信号,跟随电机控制器控制跟随电机6启动,驱动同步带4,使跟随装置1远离输送装置2;当拨叉105的第二触点1052与后微动开关1062脱离接触,跟随电机控制器控制跟随电机6停止,跟随装置1停止运动,此时,管线8的轴向力与预紧力相同。
由此,当输送装置2直线输送管线8时,使得跟随装置1跟随管线8做进给运动,同时,使管线8受到恒定预紧力的作用,保持直线状态;当管线8旋转时,连接套组件101中的连接套1011可以随管线8做同步旋转运动。即言,输送系统100可以使管线8在工作过程中,保持直线状态,不会绕曲,保证输送装置2能够正常输送管线。
在本发明的一个实施例中,如图8所示,传感器组件106还可以包括霍尔传感器1063和磁铁1064,霍尔传感器1063设置在第一微动开关1061和第二微动开关1062之间,且与拨叉105相对设置;磁铁1064固定在拨叉105的底部,且正对霍尔传感器1063设置。
在该实施例中,第一位置信息还可包括霍尔传感器的输出信号,当第一微动开关1061和第二微动开关1062均未被触发时,跟随电机控制器具体用于每隔第一预设时间对霍尔传感器1063的输出信号进行一次采样,进而每隔第二预设时间根据如下公式(1)计算一次采样信号的斜率k:
其中,n为采样信号的个数,其为正整数,Fi为第i个采样信号的取值,xi为第i个采样信号的采样时刻,为n个采样电压的平均值,为n个采样时刻的平均值;
当计算得到m个斜率时,根据如下公式(2)计算一次速度值:
其中,m为正整数,是m个斜率的平均值,km是第m次计算得到的斜率,v是当前计算出的速度值,v′是上一次计算出的速度值,p是比例参数。
当计算出的速度值大于预设上限速度时,控制跟随电机以预设上限速度运行;当计算出的速度值小于或者等于预设上限速度时,则控制跟随电机以计算出的速度值运动。
在本发明的一个实施例中,如图9所示,输送装置2包括后端盖21、摩擦轮芯组件22、前端盖组件23、进给组件24、固定件25,其中,摩擦轮芯组件22设置在前端盖组件23中,可由限位块限位,后端盖21与前端盖组件23固定连接,进给组件24与前端盖组件23啮合,固定件25与前端盖组件23固定连接,将前端盖组件23和进给组件24组合。其中,管线8由固定件25的中心孔穿入,经过前端盖组件23以及摩擦轮芯组件22,并从后端盖21的中心孔穿出。
进一步地,如图1、图2、图10所示,管线输送系统100还包括驱动装置10,驱动装置10包括基座11和动力组件12、管线位置激光传感器13和管线电机控制器(图中未示出)。
其中,输送装置2安装在基座11上,且基座11相对地面固定设置。动力组件12安装在基座11上,动力组件12包括管线进给电机201和管线旋转电机202,管线进给电机201和管线旋转电机202与输送装置2配合以驱动管线8运动;管线位置激光传感器13可设置在输送装置2的后端盖21处,用于检测管线8的位置并生成第二位置信息。
在该实施例中,管线电机控制器分别与管线进给电机201、管线旋转电机202和管线位置激光传感器13电连接,管线电机控制器用于根据第二位置信息分别对管线给进电机201与管线旋转电机202进行控制。
可选地,跟随电机控制器和管线电机控制器均可采用单片机或者FPGA(FieldProgrammable Gate Array,即现场可编程门阵列)。
在本发明的一个具体实施例中,管线输送系统100的工作流程如下:
步骤1,管线电机控制器接收到控制管线8向前运动10mm的控制指令,根据该指令控制导管进给电机201转动,以使得管线8向前运动。
步骤2,管线8向前运动拉拽跟随装置1向前运动,霍尔传感器1063检测到磁铁1064位置变化,但第一微动开关1061还没有被触发,跟随电机控制器根据霍尔传感器1063的输出信号,采用预测控制算法得出跟随电机6的方向、转速,控制跟随电机6正向转动,使得安装组件3和跟随装置1向前运动。
步骤3,当管线8向前运动速度较快时,会使得第一微动开关1061触发,此时跟随电机控制器会控制跟随电机6以上限速度(等于管线8向前的上限速度)向前运动。
步骤4,当管线8速度减慢之后,第一微动开关1061会慢慢脱离触发状态,此时跟随电机控制器会再次根据霍尔传感器1063的输出量,采用预测控制算法得出跟随电机6的方向、转速来控制电机运动,
步骤5,重复步骤3-4,直至管线电机控制器控制管线进给电机201和管线旋转电机202停止时,磁铁1064慢慢回到中间位置,霍尔传感器1063的输出信号等于0,跟随电机控制器控制跟随电机6停止运动,整个过程完成。
具体地,上述预测控制算法如下:
霍尔传感器1063的输出信号为输出电压U,其输出电压代表了磁铁1064相对于霍尔传感器1063的位置,当磁铁1064在霍尔传感器1063正上方时,输出电压为2.5V,当磁铁1064在霍尔传感器1063最左端时,输出电压为0V,当磁铁1064在霍尔传感器1063最右端时,输出电压为5V,其位置值与霍尔传感器1063的输出电压成非线性关系。
每100μs,对霍尔传感器1063的输出电压采样一次,得到采样值F,其与输出电压的关系为
假设跟随电机6的轴承直径为d,则跟随电机6每正转一圈同步带4带动跟随装置1向前运动S,其中,S=2×π×d。
对连续10次霍尔传感器1063的输出电压进行采样,采样值表示为F1,F2,...F10,这10次采样的时刻为:1,2...10,用x1,x2...x10代替,根据上式(1)对这十个采样值做线性拟合,得出采样电压的斜率其中,
也就是每1ms得出一个斜率值k,对下一次连续10次采样值F继续做线性拟合,得到斜率k1,k2...k10,然后将上述操作进行10次,得出连续10次斜率。
对连续10次的斜率值进行滑动平均,得出平均值然后与第十次斜率k10进行比较,得出速度其中,v′是上一次计算出的速度值,p是比例参数,其可通过实验分析得到,此例中p取值1.62。当计算出的v>v1时,以v1控制跟随电机运行。当管线运动速度达到v1时,第一微动开关1061会触发,使得跟随电机6也按照v1运动,否则按照计算出的速度v运动。其中,v1为预设上限速度。
需要说明的是,上述预测控制算法,在控制跟随电机6运动时,根据管线速度的斜率变化率可以预测到管线速度的变化趋势,使得跟随电机6可以提前快速跟随上管线的速度。
举例而言,当线性拟合出的k1,k2...k10分别是1.1,1.2,...2.0时,计算得到v=0.45p+v′,此时管线速度在不断上升;当线性拟合出的k1,k2...k10分别是2.0,1.9,...1.1时,计算得到v=-0.45p+v′,此时管线速度在不断下降。
由于,管线的速度变化都是连续的,因此,可以通过计算速度的变化趋势,来估计管线在下一次的速度。
综上,根据本发明实施例的管线输送系统,在介入手术时,输送装置输送管线做直线运动或旋转运动,当管线轴向力小于预紧力时,控制跟随电机转动,跟随装置在同步带的驱动下,向远离输送装置的方向移动,当达到预紧力要求时,跟随电机停止工作,跟随装置保持位置不变;当管线的轴向力大于预紧力时,控制跟随电机转动,跟随装置在同步带的驱动下,向靠近输送装置的方向移动,当达到预紧力要求时,跟随电机停止工作,跟随装置保持位置不变。由此,能够保证管线受恒定预紧力作用,保持直线状态,不会绕曲,保证输送装置正常输送管线。
基于上述管线输送系统,本发明提出了一种管线输送系统的控制方法。
图11是根据本发明实施的管线输送系统的控制方法的流程图。如图1所示,该控制方法包括以下步骤:
S1,接收用户输入的管线输送指令。
S2,检测输送装置输送的管线的位置,以得到第二位置信息。
S3,根据管线输送指令和第二位置信息对管线进给电机和/或管线旋转电机进行控制。
其中,管线进给电机和管线旋转电机与输送装置配合以驱动管线运动。
S4,检测跟随装置夹持的管线的位置,以得到第一位置信息,并根据第一位置信息对跟随电机进行控制。
具体地,当第一位置信息至少包括第一触发信号时,根据第一触发信号控制跟随电机以预设上限速度和第一方向转动;当第一位置信息至少包括第二触发信号时,根据第二触发信号控制跟随电机以预设上限速度和第二方向转动;当第一位置信息仅包括霍尔传感器的输出信号时,根据霍尔传感器的输出信号对跟随电机进行控制。
其中,第一位置信息中不会同时包含第一触发信号和第二触发信号。
在该实施例中,根据霍尔传感器的输出信号对跟随电机进行控制包括如下步骤:
S41,每隔第一预设时间对霍尔传感器的输出信号进行一次采样。
S42,每隔第二预设时间根据如下公式(1)计算一次采样信号的斜率k:
其中,n为采样信号的个数,Fi为第i个采样信号的取值,xi为第i个采样信号的采样时刻,为n个采样电压的平均值,为n个采样时刻的平均值;
S43,当计算得到m个斜率时,根据如下公式(2)计算一次速度值:
其中,是m个斜率的平均值,km是第m次计算得到的斜率,v是当前计算出的速度值,v′是上一次计算出的速度值,p是比例参数;
S44,当计算出的速度值大于预设上限速度时,控制跟随电机以预设上限速度运行。
S45,当计算出的速度值小于或者等于预设上限速度时,则控制跟随电机以计算出的速度值运动。
需要说明的是,本发明实施例的管线输送系统的控制方法的其他具体实施方式,可参见本发明上述实施例的管线输送系统的具体实施方式。
根据本发明实施例的管线输送系统的控制方法,能够保证管线受恒定预紧力作用,保持直线状态,不会绕曲,进而保证输送装置正常输送管线。
在本说明书的描述中,参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中,对上述术语的示意性表述不一定指的是相同的实施例或示例。而且,描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
在本发明的描述中,需要理解的是,术语“中心”、“纵向”、“横向”、“长度”、“宽度”、“厚度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”“内”、“外”、“顺时针”、“逆时针”、“轴向”、“径向”、“周向”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。
此外,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本发明的描述中,“多个”的含义是至少两个,例如两个,三个等,除非另有明确具体的限定。
在本发明中,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”、“固定”等术语应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或成一体;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通或两个元件的相互作用关系,除非另有明确的限定。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。
在本发明中,除非另有明确的规定和限定,第一特征在第二特征“上”或“下”可以是第一和第二特征直接接触,或第一和第二特征通过中间媒介间接接触。而且,第一特征在第二特征“之上”、“上方”和“上面”可是第一特征在第二特征正上方或斜上方,或仅仅表示第一特征水平高度高于第二特征。第一特征在第二特征“之下”、“下方”和“下面”可以是第一特征在第二特征正下方或斜下方,或仅仅表示第一特征水平高度小于第二特征。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。
Claims (12)
1.一种管线输送系统,其特征在于,包括:
输送装置,所述输送装置相对地面固定设置;
安装组件和跟随装置,所述跟随装置安装在所述安装组件上,所述跟随装置通过管线与所述输送装置相连;
跟随电机和传动组件,所述跟随电机安装在所述传动组件上,所述跟随电机带动所述传动组件转动,所述传动组件与所述安装组件相连,以在所述传动组件转动时带动所述跟随装置运动;
所述跟随装置包括:
底座,所述底座安装在所述安装组件上;
固定板,所述固定板安装在所述底座上;
导向轴支架,所述导向轴支架安装在所述固定板上;
第一导向轴和第二导向轴,所述第一导向轴和所述第二导向轴均安装在所述导向轴支架上;
滑块座,所述滑块座内限定有用于容纳连接套组件的第一容纳腔,所述滑块座与所述导向轴支架之间通过拉伸弹簧连接,其中,所述连接套组件通过所述管线与所述输送装置相连,所述拉伸弹簧的两端分别通过第一圆柱销和第二圆柱销固定;
第一直线轴承和第二直线轴承,所述第一直线轴承和所述第二直线轴承均安装在所述滑块座内,并分别对应安装在所述第一导向轴与所述第二导向轴上,其中,所述滑块座在所述第一导向轴与所述第二导向轴上可移动;
滑块上盖,所述滑块上盖与所述第一导向轴和所述第二导向轴可活动地相连以打开和关闭所述第一容纳腔。
2.根据权利要求1所述的管线输送系统,其特征在于,所述传动组件包括:
主动带轮和从动带轮,所述主动带轮与所述跟随电机相连;
同步带,所述同步带的两端分别套设在所述主动带轮和所述从动带轮上;
其中,所述跟随电机驱动所述主动带轮转动,以带动所述同步带运动。
3.根据权利要求1所述的管线输送系统,其特征在于,所述滑块上盖的一端安装在所述第一导向轴上,并绕所述第一导向轴可旋转,所述滑块上盖另一端设有缺口,并可压紧安装在所述第二导向轴上。
4.根据权利要求1所述的管线输送系统,其特征在于,所述连接套组件包括:
连接套,所述连接套用于夹持管线的尾端;
第一轴承和第二轴承,所述第一轴承和所述第二轴承均安装在所述连接套上;
护套,所述护套内限定有用于容纳所述连接套、所述第一轴承和所述第二轴承的第二容纳腔,且所述连接套在所述第二容纳腔中可旋转,所述护套上设有第一定位孔和第二定位孔,其中,所述滑块上盖的定位块嵌入连接在所述第一定位孔中,所述滑块座的定位块嵌入连接在所述第二定位孔中。
5.根据权利要求4所述的管线输送系统,其特征在于,所述跟随装置还包括:
拨叉,所述拨叉安装在所述滑块座的下端,且设置在所述底座的一侧,所述拨叉的下端悬空;
传感器组件,所述传感器组件安装在所述底座上,且设置在所述拨叉的下端,所述传感器组件用于检测夹持在所述连接套中的管线的位置,并生成第一位置信息;
跟随电机控制器,所述跟随电机控制器分别与所述传感器组件和所述跟随电机电连接,所述跟随电机控制器用于根据所述第一位置信息生成相应的控制指令,并根据所述控制指令对所述跟随电机进行控制。
6.根据权利要求5所述的管线输送系统,其特征在于,所述传感器组件包括:
第一微动开关,所述第一微动开关与所述拨叉的第一触点对应设置,且当所述管线的轴向力大于预紧力时,所述第一微动开关与所述第一触点接触,并生成第一触发信号;
第二微动开关,所述第二微动开关与所述拨叉的第二触点对应设置,且当所述管线的轴向力小于预紧力时,所述第二微动开关与所述第二触点接触,并生成第二触发信号;
其中,所述第一位置信息包括所述第一触发信息和所述第二触发信息,所述跟随电机控制器根据所述第一触发信号控制所述跟随电机以预设上限速度和第一方向转动,以及根据所述第二触发信号控制所述跟随电机以所述预设上限速度和第二方向转动。
7.根据权利要求6所述的管线输送系统,其特征在于,所述传感器组件还包括:
霍尔传感器,所述霍尔传感器设置在所述第一微动开关和所述第二微动开关之间,且与所述拨叉相对设置;
磁铁,所述磁铁固定在所述拨叉的底部,且正对所述霍尔传感器设置;
其中,所述第一位置信息还包括所述霍尔传感器的输出信号,当所述第一微动开关和所述第二微动开关均未被触发时,所述跟随电机控制器具体用于:
每隔第一预设时间对所述霍尔传感器的输出信号进行一次采样;
每隔第二预设时间根据如下公式计算一次采样信号的斜率k:
其中,n为采样信号的个数,Fi为第i个采样信号的取值,xi为第i个采样信号的采样时刻,为n个采样电压的平均值,为n个采样时刻的平均值;
当计算得到m个斜率时,根据如下公式计算一次速度值:
其中,是m个斜率的平均值,km是第m次计算得到的斜率,v是当前计算出的速度值,v′是上一次计算出的速度值,p是比例参数;
当计算出的速度值大于所述预设上限速度时,控制所述跟随电机以所述预设上限速度运行;以及
当计算出的速度值小于或者等于所述预设上限速度时,则控制所述跟随电机以所述计算出的速度值运动。
8.根据权利要求1所述的管线输送系统,其特征在于,所述输送装置包括后端盖、摩擦轮芯组件、前端盖组件、进给组件、固定件,其中,所述摩擦轮芯组件设置在所述前端盖组件中,所述后端盖与所述前端盖组件固定连接,所述进给组件与所述前端盖组件啮合,所述固定件与所述前端盖组件固定连接,将所述前端盖组件和所述进给组件组合。
9.根据权利要求8所述的管线输送系统,其特征在于,还包括驱动装置,所述驱动装置包括:
基座,所述输送装置安装在所述基座上,且所述基座相对地面固定设置;
动力组件,所述动力组件安装在所述基座上,所述动力组件包括管线进给电机和管线旋转电机,所述管线进给电机和所述管线旋转电机与所述输送装置配合以驱动管线运动;
管线位置激光传感器,所述管线位置激光传感器设置在所述输送装置的后端盖处,用于检测管线的位置并生成第二位置信息;
管线电机控制器,所述管线电机控制器分别与所述管线进给电机、所述管线旋转电机和所述管线位置激光传感器电连接,所述管线电机控制器用于根据所述第二位置信息分别对所述管线给进电机和所述管线旋转电机进行控制。
10.一种根据权利要求1-9中任一项所述的管线输送系统的控制方法,其特征在于,包括以下步骤:
接收用户输入的管线输送指令;
检测所述输送装置输送的管线的位置,以得到第二位置信息;
根据所述管线输送指令和所述第二位置信息对管线进给电机和/或管线旋转电机进行控制,其中,所述管线进给电机和所述管线旋转电机与所述输送装置配合以驱动管线运动;
检测所述跟随装置夹持的所述管线的位置,以得到第一位置信息,并根据所述第一位置信息对所述跟随电机进行控制。
11.根据权利要求10所述的管线输送系统的控制方法,其特征在于,所述根据所述第一位置信息对所述跟随电机进行控制,包括:
当所述第一位置信息至少包括第一触发信号时,根据所述第一触发信号控制所述跟随电机以预设上限速度和第一方向转动;
当所述第一位置信息至少包括第二触发信号时,根据所述第二触发信号控制所述跟随电机以所述预设上限速度和第二方向转动;
当所述第一位置信息仅包括霍尔传感器的输出信号时,根据所述霍尔传感器的输出信号对所述跟随电机进行控制。
12.根据权利要求11所述的管线输送系统的控制方法,其特征在于,所述根据所述霍尔传感器的输出信号对所述跟随电机进行控制,包括:
每隔第一预设时间对所述霍尔传感器的输出信号进行一次采样;
每隔第二预设时间根据如下公式计算一次采样信号的斜率k:
其中,n为采样信号的个数,Fi为第i个采样信号的取值,xi为第i个采样信号的采样时刻,为n个采样电压的平均值,为n个采样时刻的平均值;
当计算得到m个斜率时,根据如下公式计算一次速度值:
其中,是m个斜率的平均值,km是第m次计算得到的斜率,v是当前计算出的速度值,v′是上一次计算出的速度值,p是比例参数;
当计算出的速度值大于所述预设上限速度时,控制所述跟随电机以所述预设上限速度运行;以及
当计算出的速度值小于或者等于所述预设上限速度时,则控制所述跟随电机以所述计算出的速度值运动。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201811009987.8A CN109095242B (zh) | 2018-08-31 | 2018-08-31 | 管线输送系统及其控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201811009987.8A CN109095242B (zh) | 2018-08-31 | 2018-08-31 | 管线输送系统及其控制方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN109095242A CN109095242A (zh) | 2018-12-28 |
| CN109095242B true CN109095242B (zh) | 2024-01-12 |
Family
ID=64864453
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201811009987.8A Active CN109095242B (zh) | 2018-08-31 | 2018-08-31 | 管线输送系统及其控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN109095242B (zh) |
Families Citing this family (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN117444760A (zh) * | 2023-11-08 | 2024-01-26 | 泽木焱光学科技(苏州)有限公司 | 一种非球面抛光机器人安全隔离罩 |
Citations (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1123129A (zh) * | 1994-01-13 | 1996-05-29 | 伊西康公司 | 缝合线剪切系统 |
| CN101044973A (zh) * | 2006-03-31 | 2007-10-03 | 伊西康内外科公司 | 用于与内窥镜连接的连接装置 |
| CN101492027A (zh) * | 2009-02-24 | 2009-07-29 | 中国人民解放军后勤工程学院 | 装配式管线连接器自动分发与回收作业系统 |
| CN102028548A (zh) * | 2011-01-14 | 2011-04-27 | 哈尔滨工业大学 | 腹腔微创手术机器人用夹钳式手术器械 |
| CN102310542A (zh) * | 2011-08-26 | 2012-01-11 | 张家港市杰达机械制造有限公司 | 一出八塑料管材生产设备中的牵引装置 |
| CN102341057A (zh) * | 2009-11-10 | 2012-02-01 | 奥林巴斯医疗株式会社 | 多关节机械手装置以及具有该装置的内窥镜系统 |
| WO2012059791A1 (en) * | 2010-11-05 | 2012-05-10 | Rīgas Tehniskā Universitāte | Robotic snake-like movement device |
| CN103057995A (zh) * | 2013-01-12 | 2013-04-24 | 青岛佳禾滴灌设备有限公司 | 管带生产用牵引装置及管带生产用牵引设备 |
| JP2013192015A (ja) * | 2012-03-13 | 2013-09-26 | Nippon Hoso Kyokai <Nhk> | 固体撮像装置 |
| CN203903580U (zh) * | 2014-03-05 | 2014-10-29 | 浙江海洋学院 | 牵引输送装置 |
| CN104736097A (zh) * | 2012-08-24 | 2015-06-24 | 休斯顿大学 | 用于成像导向和机器人辅助外科手术的机器人装置和系统 |
| CN204938461U (zh) * | 2015-07-03 | 2016-01-06 | 汕头东风印刷股份有限公司 | 一种运纸导向装置 |
| CN106219288A (zh) * | 2016-07-30 | 2016-12-14 | 吴劲松 | 一种具有牵引功能的数控收卷装置 |
| CN107945603A (zh) * | 2017-11-13 | 2018-04-20 | 华中科技大学鄂州工业技术研究院 | 一种两自由度虚拟手术的力反馈装置 |
| CN207404419U (zh) * | 2017-11-13 | 2018-05-25 | 湖北嘉辐达节能科技有限公司 | 用于玻璃棉的行程检测开关装置及传送系统 |
| CN108393922A (zh) * | 2018-02-10 | 2018-08-14 | 合肥工业大学 | 一种具有多自由度的机器人器械手指及用途 |
| CN208916404U (zh) * | 2018-08-31 | 2019-05-31 | 合肥美亚光电技术股份有限公司 | 管线输送系统 |
-
2018
- 2018-08-31 CN CN201811009987.8A patent/CN109095242B/zh active Active
Patent Citations (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1123129A (zh) * | 1994-01-13 | 1996-05-29 | 伊西康公司 | 缝合线剪切系统 |
| CN101044973A (zh) * | 2006-03-31 | 2007-10-03 | 伊西康内外科公司 | 用于与内窥镜连接的连接装置 |
| CN101492027A (zh) * | 2009-02-24 | 2009-07-29 | 中国人民解放军后勤工程学院 | 装配式管线连接器自动分发与回收作业系统 |
| CN102341057A (zh) * | 2009-11-10 | 2012-02-01 | 奥林巴斯医疗株式会社 | 多关节机械手装置以及具有该装置的内窥镜系统 |
| WO2012059791A1 (en) * | 2010-11-05 | 2012-05-10 | Rīgas Tehniskā Universitāte | Robotic snake-like movement device |
| CN102028548A (zh) * | 2011-01-14 | 2011-04-27 | 哈尔滨工业大学 | 腹腔微创手术机器人用夹钳式手术器械 |
| CN102310542A (zh) * | 2011-08-26 | 2012-01-11 | 张家港市杰达机械制造有限公司 | 一出八塑料管材生产设备中的牵引装置 |
| JP2013192015A (ja) * | 2012-03-13 | 2013-09-26 | Nippon Hoso Kyokai <Nhk> | 固体撮像装置 |
| CN104736097A (zh) * | 2012-08-24 | 2015-06-24 | 休斯顿大学 | 用于成像导向和机器人辅助外科手术的机器人装置和系统 |
| CN103057995A (zh) * | 2013-01-12 | 2013-04-24 | 青岛佳禾滴灌设备有限公司 | 管带生产用牵引装置及管带生产用牵引设备 |
| CN203903580U (zh) * | 2014-03-05 | 2014-10-29 | 浙江海洋学院 | 牵引输送装置 |
| CN204938461U (zh) * | 2015-07-03 | 2016-01-06 | 汕头东风印刷股份有限公司 | 一种运纸导向装置 |
| CN106219288A (zh) * | 2016-07-30 | 2016-12-14 | 吴劲松 | 一种具有牵引功能的数控收卷装置 |
| CN107945603A (zh) * | 2017-11-13 | 2018-04-20 | 华中科技大学鄂州工业技术研究院 | 一种两自由度虚拟手术的力反馈装置 |
| CN207404419U (zh) * | 2017-11-13 | 2018-05-25 | 湖北嘉辐达节能科技有限公司 | 用于玻璃棉的行程检测开关装置及传送系统 |
| CN108393922A (zh) * | 2018-02-10 | 2018-08-14 | 合肥工业大学 | 一种具有多自由度的机器人器械手指及用途 |
| CN208916404U (zh) * | 2018-08-31 | 2019-05-31 | 合肥美亚光电技术股份有限公司 | 管线输送系统 |
Non-Patent Citations (2)
| Title |
|---|
| 基于关节转角估计器的绳驱动手术微器械位置全闭环控制;王文杰;于凌涛;杨景;闫昱晟;;机器人(02);105-113 * |
| 腹腔镜直肠癌手术相关持镜技巧及经验总结;游清;龚航军;韩刚;王以东;曹羽;张云;;腹腔镜外科杂志(06);80-82 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN109095242A (zh) | 2018-12-28 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| EP1561413B1 (en) | Endoscopic therapeutic system | |
| SE535165C2 (sv) | Justerdon för automatisk svetstrådmatning samt för justering av en trådframmatning. | |
| US11554409B2 (en) | Rebar tying tool and electric work machine | |
| CN109095242B (zh) | 管线输送系统及其控制方法 | |
| EP1808956A3 (en) | Driving apparatus and driving system for electric motor | |
| CN110806190B (zh) | 形状测定装置 | |
| CN208916404U (zh) | 管线输送系统 | |
| US10086632B1 (en) | Printing apparatus | |
| CN210542327U (zh) | 一种按摩机芯及按摩椅 | |
| CN211496330U (zh) | 恒张力放线系统 | |
| CN106461605B (zh) | 转印膜保持器具和分离转印装置 | |
| JPH11182136A (ja) | 自動開閉装置 | |
| AU2018314413A1 (en) | Driving apparatus and method for using a driving apparatus | |
| CN103910242A (zh) | 马达拉动式料带张力控制机构 | |
| JPH11208997A (ja) | 線条体の張力調整方法及び装置 | |
| JPH11283459A (ja) | 圧力感知装置 | |
| US10099492B1 (en) | Printing apparatus | |
| CN116999159A (zh) | 用于介入手术机器人控制端的拟真操作手柄及其控制方法 | |
| JP2006326679A (ja) | ロボット溶接制御装置 | |
| KR102037213B1 (ko) | 환상 동심 꼬임 코드의 제조 장치 및 그에 이용하는 카세트 | |
| JPH11271154A (ja) | 圧力検出装置 | |
| JP3692700B2 (ja) | スライド式ドア用給電構造 | |
| CN118208966B (zh) | 炉门状态检测装置和炉门开合装置 | |
| JP2012065838A (ja) | 車椅子用ウインチ装置 | |
| JPS58135051A (ja) | テ−プハンドリング装置 |
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 |