一种深海多关节潜器的控制方法转让专利
申请号 : CN201910628071.9
文献号 : CN110422307B
文献日 : 2021-03-30
发明人 : 孟庆浩 , 刘科显 , 张宏伟 , 刘迎澍 , 任超
申请人 : 天津大学
摘要 :
权利要求 :
1.一种深海多关节潜器的控制方法,所适用的多关节潜器包括导流舱、控制舱、推进舱、推进器和尾舵,其中,导流舱与控制舱之间通过一个两自由度关节连接,控制舱与推进舱之间通过另一个两自由度关节连接,推进器固定连接于推进舱的后部,尾舵绕轴线均布于推进舱后部;所述控制舱为潜器干舱部分,采用耐压设计,内部两侧对称分布两个滑道,包括控制舱壳、电池、电源、铱星通讯模块、GPS通讯模块、中央控制器和两个陀螺仪,驱动两个两自由度关节的电机和驱动器均置于控制舱内;电池固定在控制舱壳内部的滑道上;两个陀螺仪所探测的两自由度关节的角度信息传送至中央控制器,铱星通讯模块和GPS通讯模块与中央控制器相连,控制方法如下:
多关节潜器由推进器提供动力,通过两自由度关节转动,实现导流舱和推进舱俯仰运动和偏航运动,改变导流舱、控制舱和推进舱之间的相对位置,使多关节潜器本体具有一定柔性,进而改变多关节潜器水动力特性,实现潜器上浮、下潜、转向和定深巡航运动方式;
多关节潜器需要下潜时,驱动两自由度关节带动导流舱和控制舱向下转动,推进器提供推力,在推力和水作用力的作用下实现潜器下潜;通过调整推进器的推力和两自由度关节的转动角度,控制潜器的下潜速度和下潜路径;
多关节潜器需要上浮时,驱动两自由度关节,带动导流舱和推进舱向上转动,推进器提供推力,在推力和水作用力的作用下实现潜器上浮;通过调整推进器的推力和两自由度关节转动角度,控制潜器的上浮速度和上浮路径;在推进器失去动力或控制舱进水紧急情况下,抛载机构释放所搭载的重物,使潜器获得正浮力,从而快速上浮至水面;
多关节潜器进行转弯时,驱动两自由度关节,使导流舱和推进舱相向偏航运动,推进器提供推力,在推力和水作用力的作用下实现多关节潜器转向;通过调整两自由度关节转动角度控制潜器的转弯半径和转弯路径;
多关节潜器巡航时,根据潜器位姿和航行情况调整导流舱俯仰角度,使潜器保持巡航深度和巡航方向,并定期浮出水面,通过GPS校准航向;
所述的两自由度关节,包括驱动单元和传动单元,所述驱动单元的前盖支耳部和传动单元的传动轴A相连接;
所述的驱动单元,包括两个驱动器、电机架、前盖、两台电机、联轴器、端盖A、驱动轴、组合密封、端盖B、套筒A、端盖C、锥齿轮A、轴承A、轴承套筒、轴承B、套筒B;电机架下部为截面圆形,两侧设有长圆形减轻孔,下面有截面圆形面,并分别开设三个通孔,上部端面上设两个倒L型支耳,支耳端面设置通孔;电机架安装在前盖上;两台电机的输出轴分别通过两个联轴器和两根驱动轴连接;驱动轴为阶梯轴,一侧设有两个螺纹孔;两个驱动器安装在电机架的L型支耳侧面;两个套筒B分别安装在两个驱动轴上,轴承B 内圈两侧贴紧套筒B和驱动轴轴肩;轴承B置于轴承套筒内,轴承套筒端面均布设有六个通孔;端盖A通过螺钉连接将轴承套筒紧固在前盖上;前盖为圆形,一端向内凹,设置有螺纹孔,另一端两边各设有支耳,支耳端部为圆形,在圆形内部设有圆孔;前盖内凹一侧的两个圆孔内做动密封设计,两个轴承A分别安装在两个圆孔内,轴承A内圈紧靠驱动轴轴肩和套筒A;两个端盖B与前盖螺纹连接,并压紧轴承A外圈,保证轴承A轴向定位,两个锥齿轮A分别安装在两个驱动轴上,锥齿轮A后端面紧靠套筒A,两个端盖C分别与两个驱动轴螺纹连接,并压紧锥齿轮A;
所述传动单元,包括齿轮架、后盖、传动轴A、轴承C、端盖D、组合齿轮、套筒E、传动轴B、轴承E、套筒D、锥齿轮B、套筒C、端盖I、轴承D、端盖E、端盖G、端盖F、端盖H;所述组合齿轮由前后两个锥齿组成,前锥齿具有完整圆周轮齿,后锥齿轮具有六分之一圆周轮齿,可根据关节最大转角调整后锥齿轮结构;组合齿轮两侧端面设有阶梯孔,在前后端面均布设有六个螺纹孔,两个组合齿轮对称安装在传动轴A上;四个轴承C分别安装在两个组合齿轮两端的阶梯孔内,端盖D与组合齿轮前后端面螺纹连接,压紧轴承C外圈;通过套筒E、传动轴A轴肩和套筒C实现组合齿轮和轴承C轴向定位;齿轮架为方形结构,外表面分别设有凸台,在凸台上分别设有台阶孔,并在台阶孔内均布设有六个螺纹通孔,两个轴承D分别安装在齿轮架左右两侧台阶孔内,两个端盖E分别安装在齿轮架左右两侧,并压紧轴承D外圈,套筒C顶住轴承D内圈;组合齿轮后锥齿与锥齿轮A啮合;传动轴A为具有对称结构的阶梯轴,在轴两端设置长圆形凸台,并安装在齿轮架左右两孔的轴承D上;端盖I设有长圆形通孔,分别螺纹连接在前盖支耳部两侧;传动轴A两端长圆形凸台分别与两个端盖I的长圆形通孔配合;两个轴承E分别安装在齿轮架上下两侧的台阶孔内,两个端盖F分别螺纹连接在齿轮架上下两侧的台阶孔内,并压紧轴承E外圈;传动轴B为阶梯轴,一侧端面设有螺纹孔,另一侧端面设有长圆形凸台,并分别安装在齿轮架上下两孔中的轴承E上;锥齿轮B端面设有通孔,并分别安装在两个传动轴B上,套筒D两侧紧靠锥齿轮B后端面和轴承E内圈,端盖G螺纹连接在传动轴B上,并压紧锥齿轮B,锥齿轮B与组合齿轮前锥齿轮啮合;端盖H设有长圆形通孔,与后盖螺纹连接,并与传动轴B轴端长圆形凸台配合;后盖为圆形,一端向内凹,设置有螺纹孔,另一端两边各设有支耳,支耳端部为圆形,在圆形内部设有圆孔,圆孔周边均布设有螺纹孔,并在后盖端面开设多个减轻孔。
说明书 :
一种深海多关节潜器的控制方法
技术领域
背景技术
海自主式潜器是海洋研究与开发的重要装备,可搭载温盐深仪、多普勒计程仪、机械手等电
子和机械设备,实现大范围的海洋勘探和科教等作业任务。
的潜器。浙江大学发明了一种混合型水下航行探测器{专利CN201210362056},融合了水下
自主航行器和水下滑翔机的特点,根据需求选择水下航行器模式或水下滑翔机模式。中国
船舶重工集团公司第七一九研究所发明了一种前后安装多个机械臂的深海无人潜器{专利
CN201610525632},利用机械臂的摆动辅助潜器的位姿调节,可实现较高的稳定性和较强的
抗流能力,但采用压载水舱的方式调节浮力,降低潜器的有效载荷,且必须至少具有一个机
械臂。哈尔滨工程大学发明了一种高速水下自主航行器{专利CN201310131690},采用气泡
发生器生成气泡,从而降低航行器运动的阻力,可在不消耗内部电源的情况下短时间内提
升航行器的速度,扩大作业范围。现有深海潜器普遍具有以下不足之处:
发明内容
非尾舵控制或液压/载水仓实现转向及姿态控制。本发明所采用的技术方案是:
舱之间通过另一个两自由度关节连接,推进器固定连接于推进舱的后部,尾舵绕轴线均布
于推进舱后部;所述控制舱为潜器干舱部分,采用耐压设计,内部两侧对称分布两个滑道,
包括控制舱壳、电池、电源、铱星通讯模块、GPS通讯模块、中央控制器和两个陀螺仪,驱动两
个两自由度关节的电机和驱动器均置于控制舱内;控制舱壳为潜器干舱部分,通过高压密
封套件以保证干舱的密封性;电池固定在控制舱壳内部的滑道上;两个陀螺仪所探测的两
自由度关节的角度信息传送至中央控制器,铱星通讯模块和GPS通讯模块与中央控制器相
连;控制方法如下:
一定柔性,进而改变多关节潜器水动力特性,实现潜器上浮、下潜、转向和定深巡航运动方
式;
度关节的转动角度,控制潜器的下潜速度和下潜路径;
度关节转动角度,控制潜器的上浮速度和上浮路径;在推进器失去动力或控制舱进水等紧
急情况下,抛载机构释放所搭载的重物,使潜器获得较大的正浮力,从而快速上浮至水面;
转动角度控制潜器的转弯半径和转弯路径。
截面圆形,两侧设有长圆形减轻孔,下面有截面圆形面,并分别开设三个通孔,上部端面上
设两个倒L型支耳,支耳端面设置通孔;电机架安装在前盖上;两台电机的输出轴分别通过
两个联轴器和两根驱动轴连接;驱动轴为阶梯轴,一侧设有两个螺纹孔;两个驱动器安装在
电机架的L型支耳侧面;两个套筒B分别安装在两个驱动轴上,轴承B内圈两侧贴紧套筒B和
驱动轴轴肩;轴承B置于轴承套筒内,轴承套筒端面均布设有六个通孔;端盖A通过螺钉连接
将轴承套筒紧固在前盖上;前盖为圆形,一端向内凹,设置有螺纹孔,另一端两边各设有支
耳,支耳端部为圆形,在圆形内部设有圆孔;前盖内凹一侧的两个圆孔内做动密封设计,两
个轴承A分别安装在两个圆孔内,轴承A内圈紧靠驱动轴轴肩和套筒A;两个端盖B与前盖螺
纹连接,并压紧轴承A外圈,保证轴承A轴向定位,两个锥齿轮A分别安装在两个驱动轴上,锥
齿轮A后端面紧靠套筒A,两个端盖C分别与两个驱动轴螺纹连接,并压紧锥齿轮A;
轮由前后两个锥齿组成,前锥齿具有完整圆周轮齿,后锥齿轮具有六分之一圆周轮齿,可根
据关节最大转角调整后锥齿轮结构;组合齿轮两侧端面设有阶梯孔,在前后端面均布设有
六个螺纹孔,两个组合齿轮对称安装在传动轴A上;四个轴承C分别安装在两个组合齿轮两
端的阶梯孔内,端盖D与组合齿轮前后端面螺纹连接,压紧轴承C外圈;通过套筒E、传动轴A
轴肩和套筒C实现组合齿轮和轴承C轴向定位;齿轮架为方形结构,外表面分别设有凸台,在
凸台上分别设有台阶孔,并在台阶孔内均布设有六个螺纹通孔,两个轴承D分别安装在齿轮
架左右两侧台阶孔内,两个端盖E分别安装在齿轮架左右两侧,并压紧轴承D外圈,套筒C顶
住轴承D内圈;组合齿轮后锥齿与锥齿轮A啮合;传动轴A为具有对称结构的阶梯轴,在轴两
端设置长圆形凸台,并安装在齿轮架左右两孔的轴承D上;端盖I设有长圆形通孔,分别螺纹
连接在前盖支耳部两侧;传动轴A两端长圆形凸台分别与两个端盖I的长圆形通孔配合;两
个轴承E分别安装在齿轮架上下两侧的台阶孔内,两个端盖F分别螺纹连接在齿轮架上下两
侧的台阶孔内,并压紧轴承E外圈;传动轴B为阶梯轴,一侧端面设有螺纹孔,另一侧端面设
有长圆形凸台,并分别安装在齿轮架上下两孔中的轴承E上;锥齿轮B端面设有通孔,并分别
安装在两个传动轴B上,套筒D两侧紧靠锥齿轮B后端面和轴承E内圈,端盖G螺纹连接在传动
轴B上,并压紧锥齿轮B,锥齿轮B与组合齿轮前锥齿轮啮合;端盖H设有长圆形通孔,与后盖
螺纹连接,并与传动轴B轴端长圆形凸台配合;后盖为圆形,一端向内凹,设置有螺纹孔,另
一端两边各设有支耳,支耳端部为圆形,在圆形内部设有圆孔,圆孔周边均布设有螺纹孔,
并在后盖端面开设多个减轻孔。
附图说明
器架A15、上仪器架A16、浮力材料B17、导流舱壳18、水声通讯仪19、上紧固架20、下紧固架
21、抛载架22、抛载机构23、浮力材料A24、大紧固架B25、大紧固架A26、计程仪架27、浮力材
料D28、推进舱壳29、天线30、浮力材料C31、控制舱壳32、中央控制器33、电池34、电源模块
35、铱星通讯模块36、GPS通讯模块37、安装板B38、安装板A39、陀螺仪40。
10‑13、套筒A 10‑14、端盖C10‑15、锥齿轮A 10‑16、轴承A 10‑17、轴承套筒10‑18、轴承B
10‑19、套筒B 10‑20、传动轴A 10‑21、轴承C 10‑22、端盖D 10‑23、组合齿轮10‑24、套筒E
10‑25、传动轴B 10‑26、轴承E 10‑27、套筒D 10‑28、锥齿轮B 10‑29、套筒C 10‑30、端盖I
10‑31、轴承D 10‑32、端盖E 10‑33、端盖G 10‑34、端盖F 10‑35、端盖H 10‑36。
具体实施方式
深仪8、多普勒计程仪5、单点流速仪11、水听器14等仪器。控制舱3前部和后部与两自由度关
节10螺纹连接。导流舱2与推进舱4分别与控制舱前部与后部的两自由度关节10连接。推进
器7安装在推进舱4尾部。四个尾舵6绕轴线均布于推进舱4后部。三个水听器14绕轴线均布
于推进舱4前部。两个仪器架A 13分别安装在推进舱4以及导流舱2的前部和后部。温盐深仪
8紧固在仪器架A 13上。多普勒计程仪安装在推进舱4中部。天线9连接在推进舱4前部。两个
仪器架B 12分别安装在控制舱3前部和后部。
仪19、温盐深仪8、水听器14。导流舱壳18前部为椭球形,后部为圆柱形,后部下方设有两个
圆孔,后部上部设有九个圆孔。三个水听器14安装在导流舱壳18端面的三个安装孔中。浮力
材料B 17为圆柱体,中心有一个圆孔。浮力材料B 17安装在导流舱壳18的后部。浮力材料
A24的端部为椭球形,尾部为圆柱形,安装在导流舱壳的前部。下紧固架21为矩形,矩形上边
中部设置半圆槽,矩形端面两侧设置螺纹通孔。上紧固架20为半圆环,半圆环端面设置两个
长圆通孔。抛载架22为对称结构,分上下两层,均为矩形板,并在中部开设一个圆孔,下层板
两侧分别设置半圆形板,并在每侧半圆板中部设置两个长圆形减轻孔,左右设置两个圆形
减轻孔。两组上紧固架20通过螺栓贯穿下紧固架21分别安装在抛载架22上下两侧。水声通
信仪19被紧固在上紧固架20和下紧固架21之间的圆环内。下仪器架A 15通过螺栓穿过到导
流舱壳18安装在上仪器架A 16上。温盐深仪8被紧固在下仪器架A 15和上仪器架A 16之间
的圆环内。
A26、大紧固架B 25、温盐深仪8。推进舱壳29前部为圆柱形,后部为椭球形,前部下方设有两
个圆孔,上部设有九个圆孔,尾部端面设一个孔。浮力材料C 31为圆柱体,中心有一个圆孔,
安装在推进舱壳29前部。浮力材料D 28安装在推进舱壳29后部。大紧固架A26为矩形,矩形
上边中部设置半圆槽,矩形端面两侧设置螺纹通孔。大紧固架B 25为半圆环,半圆环端面设
置两个长圆通孔。计程仪架27为半圆形板,每侧半圆板中部设置两个长圆形减轻孔,左右设
置两个圆形减轻孔。一组大紧固架A26通过螺栓贯穿大紧固架B 25安装在计程仪架上侧。另
一组大紧固架A26通过螺栓贯穿大紧固架B 25安装在计程仪架27下侧。多普勒计程仪5紧固
在两组大紧固架A26和大紧固架B 25之间的圆环内。推进器7安装在推进舱壳29尾部。下仪
器架A 15通过螺栓穿过推进舱壳29安装在上仪器架A 16上。温盐深仪8被禁锢在下仪器架A
15和上仪器架A 16之间的圆弧内。
控制舱壳32为圆柱筒型,为潜器干舱部分,采用耐压设计,内部设置8道加强筋,两侧对称分
布两个滑道,两端面分别设置八个螺纹孔,选用高压密封套件以保证干舱的密封性。电池34
安装在控制舱壳32内部的滑道上,并用螺栓紧定。安装板A 39为长方形,安装在在控制舱3
前侧两自由度关节10尾部。中央控制器33安装在安装板A 39上。陀螺仪40安装在控制舱3前
侧两自由度关节10的控制舱内部分。铱星通讯模块36和GPS通讯模块37对称安装在控制舱3
后侧两自由度关节10的舱内部分。安装板B 38为长方形板,安装在控制舱3后侧两自由度关
节10尾部。电源模块35安装在安装板B 38上。
间的相对位置,使多关节潜器1本体具有一定柔性,进而改变多关节潜器1水动力特性,实现
潜器上浮、下潜、转向和定深巡航等运动方式。当潜器处于水面时,铱星通讯模块36和GPS通
讯模块37通过天线接收信息,对潜器进行定位。当潜器位于水下时,由水声通讯仪19接收信
息,并通过水听器14对潜器进行定位。
整推进器7的推力和两自由度关节10的转动角度,控制潜器的下潜速度和下潜路径。
两自由度关节10转动角度,控制潜器的上浮速度和上浮路径。在推进器7失去动力或控制舱
进水等紧急情况下,抛载机构23释放抛载架22所搭载的重物,使潜器具有较大的正浮力,从
而快速上浮至水面。
10转动角度控制潜器的转弯半径和转弯路径。
由度关节10,使潜器保持一定的巡航深度和巡航方向。
文信息,可一次性完成水平面水文信息收集,提高探测效率。
信息,可一次性完成垂向面水文信息收集,提高探测效率。
10‑21相连接。
10‑14、端盖C 10‑15、锥齿轮A 10‑16、轴承A 10‑17、轴承套筒10‑18、轴承B 10‑19、套筒B
10‑20。电机架10‑4下部为截面圆形,两侧设有长圆形减轻孔,下面有截面圆形面,并分别开
设三个通孔,上部端面上设两个倒L型支耳,支耳端面设置通孔。电机架10‑4安装在前盖上。
两台电机10‑8的输出轴分别通过两个联轴器10‑9和两根驱动轴10‑11连接。驱动轴10‑11为
阶梯轴,一侧设有两个螺纹孔。两个驱动器10‑3安装在电机架10‑4的L型支耳侧面。两个套
筒B 10‑20分别安装在两个驱动轴10‑11上,轴承B 10‑19内圈两侧贴紧套筒B 10‑20和驱动
轴10‑11轴肩。轴承B 10‑19置于轴承套筒10‑18内。轴承套筒10‑18端面均布设有六个通孔。
端盖A 10‑10通过螺钉连接将轴承套筒10‑18紧固在前盖10‑5上。前盖10‑5为圆形,一端向
内凹,设置有螺纹孔,另一端两边各设有支耳,支耳端部为圆形,在圆形内部设有圆孔,采用
耐压设计,保证安装电机10‑8和驱动器10‑3的舱段具有可靠的强度。前盖10‑5内凹一侧的
两个圆孔内做动密封设计,两个轴承A 10‑17分别安装在两个圆孔内,通过驱动轴10‑11轴
肩和套筒A 10‑14固定轴承A 10‑17内圈。两个端盖B 10‑13与前盖10‑5螺纹连接,并压紧轴
承A 10‑17外圈。两个锥齿轮A 10‑16分别安装在两个驱动轴10‑11上,锥齿轮A 10‑16后端
面紧靠套筒A 10‑14,两个端盖C 10‑15分别与两个驱动轴10‑11螺纹连接,并压紧锥齿轮A
10‑16。
10‑27、套筒D 10‑28、锥齿轮B 10‑29、套筒C 10‑30、端盖I 10‑31、轴承D 10‑32、端盖E 10‑
33、端盖G 10‑34、端盖F 10‑35、端盖H 10‑36。所述组合齿轮10‑24由前后两个锥齿组成,前
锥齿具有完整圆周轮齿,后锥齿轮具有六分之一圆周轮齿,可根据关节最大转角调整后锥
齿轮结构,在两侧端面开设阶梯孔,在前后端面均布设有六个螺纹孔,两个组合齿轮10‑24
对称安装在传动轴A 10‑21上。四个轴承C 10‑22分别安装在两个组合齿轮10‑24两端的阶
梯孔内,端盖D 10‑23与组合齿轮10‑24前后端面螺纹连接,压紧轴承C 10‑22外圈。通过套
筒E 10‑25、传动轴A 10‑21轴肩和套筒C 10‑30实现组合齿轮10‑24和四个轴承C 10‑22的
轴向定位。齿轮架10‑6为方形结构,外表面分别设有凸台,在凸台上分别设有台阶孔,并在
台阶孔内均布设有六个螺纹通孔,两个轴承D 10‑32分别安装在齿轮架10‑6左右两侧台阶
孔内,两个端盖E 10‑33分别安装在齿轮架10‑6左右两侧,并压紧轴承D 10‑32外圈,套筒C
10‑30顶住轴承D 10‑32内圈。组合齿轮10‑24后锥齿与锥齿轮A 10‑16啮合。传动轴A 10‑21
为具有对称结构的阶梯轴,在轴两端设置长圆形凸台,安装在齿轮架10‑6左右两孔的轴承D
10‑32上。端盖I 10‑31设有长圆形通孔,分别螺纹连接在前盖10‑5支耳部两侧。传动轴A
10‑21两端长圆形凸台分别与两个端盖I 10‑31的长圆形通孔配合。两个轴承E 10‑27分别
安装在齿轮架10‑6上下两侧的台阶孔内,两个端盖F 10‑35分别螺纹连接在齿轮架10‑6上
下两侧的台阶孔内,并压紧轴承E 10‑27外圈。传动轴B 10‑26为阶梯轴,并在一侧端面设有
螺纹孔,另一侧端面设有长圆形凸台,两个传动轴B 10‑26安装在齿轮架10‑6上下两孔中的
轴承E 10‑27上。锥齿轮B 10‑29端面设有通孔,分别安装在两个传动轴B 10‑26上,套筒D
10‑28两侧紧靠锥齿轮B 10‑29后端面和轴承E 10‑27内圈,端盖G 10‑34螺纹连接在传动轴
B 10‑26上,并压紧锥齿轮B 10‑29。锥齿轮B 10‑29与组合齿轮10‑24前锥齿轮啮合。端盖H
10‑36设有长圆形通孔,与后盖10‑7螺纹连接,并与传动轴B 10‑26轴端长圆形凸台配合。后
盖10‑7为圆形,一端向内凹,设置有螺纹孔,另一端两边各设有支耳,支耳端部为圆形,在圆
形内部设有圆孔,圆孔周边均布设有六个螺纹孔,并在后盖端面开设多个减轻孔。
动,电机架10‑6内部齿轮组锁死,电机架10‑6带动后盖10‑7绕传动轴A 10‑21旋转。
构,电机架10‑6带动后盖10‑7绕传动轴B 10‑26旋转。
可以应用于机械臂、仿生机器人等具有多自由度的机电设备,根据具体需求调整前盖10‑4
和后盖10‑7与设备之间的连接方式。