CN117991834A - 一种应用于水下载人航行器的侧杆结构及水下载人航行器 - Google Patents
一种应用于水下载人航行器的侧杆结构及水下载人航行器 Download PDFInfo
- Publication number
- CN117991834A CN117991834A CN202311702430.3A CN202311702430A CN117991834A CN 117991834 A CN117991834 A CN 117991834A CN 202311702430 A CN202311702430 A CN 202311702430A CN 117991834 A CN117991834 A CN 117991834A
- Authority
- CN
- China
- Prior art keywords
- module
- side rod
- rod
- active
- control module
- 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
- 238000012544 monitoring process Methods 0.000 claims abstract description 88
- 238000006073 displacement reaction Methods 0.000 claims abstract description 56
- 230000005540 biological transmission Effects 0.000 claims description 23
- 238000002955 isolation Methods 0.000 claims description 13
- 239000003638 chemical reducing agent Substances 0.000 claims description 11
- 238000010276 construction Methods 0.000 claims 1
- 238000013016 damping Methods 0.000 abstract description 12
- 238000005516 engineering process Methods 0.000 abstract description 11
- WHRZCXAVMTUTDD-UHFFFAOYSA-N 1h-furo[2,3-d]pyrimidin-2-one Chemical compound N1C(=O)N=C2OC=CC2=C1 WHRZCXAVMTUTDD-UHFFFAOYSA-N 0.000 abstract 1
- 235000006173 Larrea tridentata Nutrition 0.000 abstract 1
- 244000073231 Larrea tridentata Species 0.000 abstract 1
- 229960002126 creosote Drugs 0.000 abstract 1
- 230000033001 locomotion Effects 0.000 description 9
- 230000008859 change Effects 0.000 description 6
- 238000013459 approach Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 230000007246 mechanism Effects 0.000 description 3
- 238000000034 method Methods 0.000 description 3
- 230000010355 oscillation Effects 0.000 description 3
- 230000006399 behavior Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000009467 reduction Effects 0.000 description 2
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000016571 aggressive behavior Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000007667 floating Methods 0.000 description 1
- 238000013017 mechanical damping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000035484 reaction time Effects 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Landscapes
- Mechanical Control Devices (AREA)
Abstract
本发明提供一种应用于水下载人航行器的侧杆结构及水下载人航行器,该侧杆结构包括主动侧杆、侧杆模块、监控模块和控制模块;控制模块用于根据侧杆位移生成第一主动加载力矩,监控模块以通过第一主动加载力矩生成控制力矩电机控制主动侧杆的反向驱动力,并在水下载人航行器在当前侧杆位移下运行超过安全操纵界限时,控制模块在第一主动加载力矩的基础上生成第二主动加载力矩,监控模块以通过第二主动加载力矩控制力矩电机对反向驱动力进行调整。本发明提供的应用于水下载人航行器的侧杆结构,适应不同操纵人员对阻尼特性的需求,主动侧杆技术将安全操纵界限,航行状态等信息进行融合保证艇员做出正确的操纵行为。
Description
技术领域
本发明涉及船舶控制技术领域,尤其涉及一种应用于水下载人航行器的侧杆结构及水下载人航行器。
背景技术
水下载人航行器的主动侧杆技术,可以使艇员在操纵侧杆时有反馈控制力感,进而影响航行器的操纵性能。
目前大多数水下载人航行器的操纵控制系统的侧杆采用纯机械阻尼侧杆,结构简单,可靠性高。但无法适应不同操纵人员对阻尼特性的需求;另一方面,侧杆无法感受到航行器安全操纵界限的操纵限制。
发明内容
本发明提供一种应用于水下载人航行器的侧杆结构及水下载人航行器,用以解决现有技术中水下载人航行器的操纵控制系统无法适应不同操纵人员对阻尼特性的需求,而且无法感受到航行器安全操纵界限的操纵限制的问题。
本发明提供一种应用于水下载人航行器的侧杆结构,包括:
主动侧杆、侧杆模块、监控模块和控制模块;
所述侧杆模块包括转轴、杆力传感器、力矩电机和编码器;
所述杆力传感器与所述主动侧杆连接,并通过所述监控模块与所述控制模块电连接,用于检测主动侧杆受所述力矩电机驱动外力,并将外力反馈信号通过所述监控模块发送至所述控制模块;
所述编码器与所述力矩电机电连接,并通过所述监控模块与所述控制模块电连接,所述编码器用于检测所述主动侧杆的侧杆位移,用以将所述侧杆位移通过所述监控模块发送至所述控制模块;
所述力矩电机通过所述转轴与所述主动侧杆传动连接,所述控制模块与所述力矩电机电连接,所述控制模块用于根据所述侧杆位移生成第一主动加载力矩,所述监控模块以通过所述第一主动加载力矩生成控制所述力矩电机控制所述主动侧杆的反向驱动力,并在水下载人航行器在当前所述侧杆位移下运行超过安全操纵界限时,所述控制模块在第一主动加载力矩的基础上生成第二主动加载力矩,所述监控模块以通过所述第二主动加载力矩控制所述力矩电机对所述反向驱动力进行调整。
根据本发明提供的一种应用于水下载人航行器的侧杆结构,所述主动侧杆为具有二自由度操纵杆;
所述侧杆模块还包括隔离结构,所述转轴设有两个,分别为深度指令转轴、航向指令转轴,所述主动侧杆与所述隔离结构连接;
所述深度指令转轴通过所述隔离结构与所述主动侧杆传动连接,用于反馈所述主动侧杆所传递的深度指令;
所述航向指令转轴通过所述隔离结构与所述主动侧杆传动连接,用于反馈所述主动侧杆所传递的航向指令。
根据本发明提供的一种应用于水下载人航行器的侧杆结构,所述杆力传感器设有两个;
其中一所述杆力传感器与所述深度指令转轴连接,并通过所述监控模块与所述控制模块电连接,用于检测主动侧杆沿深度方向受所述力矩电机驱动外力,并将沿深度方向的外力反馈信号通过所述监控模块发送至所述控制模块;
另一所述杆力传感器与所述航向指令转轴连接,并通过所述监控模块与所述控制模块电连接,用于检测主动侧杆沿航向方向受所述力矩电机驱动外力,并将沿航向方向的外力反馈信号通过所述监控模块发送至所述控制模块。
根据本发明提供的一种应用于水下载人航行器的侧杆结构,所述力矩电机设有两个;
其中一所述力矩电机通过所述深度指令转轴与所述主动侧杆传动连接;
另一所述力矩电机通过所述航向指令转轴与所述主动侧杆传动连接。
根据本发明提供的一种应用于水下载人航行器的侧杆结构,所述编码器设有两个;
其中一所述力矩电机与其中一所述编码器电连接,其中一所述编码器用于检测所述主动侧杆沿深度方向的侧杆位移,用以将沿深度方向的所述侧杆位移通过所述监控模块发送至所述控制模块;
另一所述力矩电机与另一所述编码器电连接,另一所述编码器用于检测所述主动侧杆沿航向方向的侧杆位移,用以将沿航向方向的所述侧杆位移通过所述监控模块发送至所述控制模块。
根据本发明提供的一种应用于水下载人航行器的侧杆结构,所述侧杆模块还包括:减速器;所述减速器与所述力矩电机传动连接。
根据本发明提供的一种应用于水下载人航行器的侧杆结构,所述侧杆模块还包括:壳体和轴承,所述轴承设置于所述壳体,所述转轴与所述轴承连接;所述主动侧杆包括杆体和手柄;所述手柄与所述杆体连接,所述杆体与所述杆力传感器连接,所述杆体通过所述转轴与力矩电机传动连接。
根据本发明提供的一种应用于水下载人航行器的侧杆结构,所述监控模块包括:
旋转变压器、电流传感器、电机驱动模块和监控控制器;
所述力矩电机的第一信号发送端通过所述旋转变压器与所述监控控制器电连接,所述力矩电机的第二信号发送端通过所述电流传感器与所述监控控制器电连接;
所述力矩电机的信号接收端通过所述电机驱动模块与所述监控控制器电连接,所述监控控制器与所述控制模块电连接。
根据本发明提供的一种应用于水下载人航行器的侧杆结构,所述监控模块还包括:
杆力信号调制电路、位移信号调制电路和电流信号调制电路;
所述杆力传感器通过所述杆力信号调制电路与所述监控控制器电连接,所述旋转变压器通过所述位移信号调制电路与所述监控控制器电连接,所述电流传感器通过所述电流信号调制电路与所述监控控制器电连接。
本发明还提供一种水下载人航行器,包括上述任一项所述的侧杆结构。
本发明提供的一种应用于水下载人航行器的侧杆结构,通过设置主动侧杆、侧杆模块、监控模块和控制模块;将杆力传感器与主动侧杆连接,并通过监控模块与控制模块电连接,用于检测主动侧杆受所述力矩电机驱动外力,并将外力反馈信号通过监控模块发送至控制模块;编码器与力矩电机电连接,并通过监控模块与控制模块电连接,编码器用于检测主动侧杆的侧杆位移,用以将侧杆位移通过监控模块发送至控制模块;力矩电机通过转轴与主动侧杆传动连接,控制模块与力矩电机电连接,控制模块用于根据侧杆位移生成第一主动加载力矩,监控模块以通过第一主动加载力矩控制力矩电机控制主动侧杆的反向驱动力,并在水下载人航行器在当前侧杆位移下运行超过安全操纵界限时,控制模块在第一主动加载力矩的基础上生成第二主动加载力矩,监控模块以通过第二主动加载力矩控制力矩电机对反向驱动力进行调整。
该应用于水下载人航行器的侧杆结构具有多重应用价值,包括:
(1)有助于提升航行操纵安全。主动侧杆技术将安全操纵界限,航行状态等信息进行融合,反馈为侧杆反向驱动力,杆力变化能够提示艇员是否接近或超越了安全操纵范围,再通过仪表显示功能将状态更完整的传达给艇员,保证艇员做出正确的操纵行为。
(2)提升艇员操纵体验和人机工效。侧杆的控制算法,可实现对机构摩擦力补偿,并自适应调节侧杆的相应刚度、阻尼参数,从而调整操纵力感特性,降低操纵负荷,提升操纵体验。
(3)提升潜操系统控制品质。主动操纵技术,自适应调节技术将使得下达的舵杆指令更为平稳、准确和快速,将有效避免指令舵角、指令航向角、指令深度、指令变化速率等参数抖动,从而提升控制品质。
(4)有助于减员增效。主动操作杆技术将水下载人航行器多方面航行态势信息融合到杆位移和杆力中,从而实现单人操艇,减员增效。
附图说明
为了更清楚地说明本发明或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明提供一实施例提供的侧杆结构的示意图之一;
图2是本发明提供一实施例提供的侧杆结构的示意图之二;
图3是本发明提供一实施例提供的主动侧杆和侧杆模块的示意图;
图4是本发明提供一实施例提供的监控模块的示意图;
图5是本发明提供一实施例提供的安全操纵界限原理图。
附图标记:
1、侧杆模块;11、编码器;12、杆力传感器;13、力矩电机;14、隔离结构;15、深度指令转轴;16、航向指令转轴;17、减速器;18、壳体;19、转轴;2、监控模块;21、旋转变压器;22、电流传感器;23、电机驱动模块;24、监控控制器;25、杆力信号调制电路;26、位移信号调制电路;27、电流信号调制电路;3、控制模块;4、主动侧杆;41、杆体;42、手柄。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合本发明中的附图,对本发明中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
下面结合图1-图5描述本发明提供的应用于水下载人航行器的侧杆结构及水下载人航行器。
本发明提供的一实施例中,如图1至图3所示,该应用于水下载人航行器的侧杆结构包括:主动侧杆4、侧杆模块1、监控模块2和控制模块3。
本实施例中,侧杆模块1包括转轴、杆力传感器12、力矩电机13和编码器11。
其中,杆力传感器12与主动侧杆4连接,杆力传感器12并通过监控模块2与控制模块3电连接,杆力传感器12用于检测主动侧杆4受所述力矩电机驱动外力,并将外力反馈信号通过监控模块2发送至控制模块3。编码器11与力矩电机13电连接,编码器11通过监控模块2与控制模块3电连接,编码器11用于检测主动侧杆4的侧杆位移,用以将侧杆位移通过监控模块2发送至控制模块3。力矩电机13通过转轴与主动侧杆4传动连接,控制模块3与力矩电机13电连接,控制模块3用于根据侧杆位移生成第一主动加载力矩,监控模块2以通过第一主动加载力矩控制力矩电机13控制主动侧杆4的反向驱动力,并在水下载人航行器在当前侧杆位移下运行超过安全操纵界限时,控制模块3在第一主动加载力矩的基础上生成第二主动加载力矩,监控模块2以通过第二主动加载力矩控制力矩电机13对反向驱动力进行调整。并且在力矩电机13调整反向驱动力的过程中,能够根据杆力传感器12检测到的力进行比较,以对反向驱动力进行适应性调整,保证输出的力在预设范围内。
具体而言,水下载人航行器的操纵控制指令是由中央操纵控制计算机(控制模块3)生成,该指令操纵水下载人航行器的舵面,进而实现航行器水下运动的深度、航向和姿态。水下载人航行器的舵面包括竖直布置的方向舵和水平布置的升降舵,升降舵可能由一对,或分别布置于水下载人航行器艏艉的二对。
侧杆结构处于主动操纵模式状态下,中央操纵控制计算机将产生额外的反驱力矩指令到主动侧杆4,能够将理想的杆力、杆位移回馈给艇员。
也即,在水下载人航行器在当前侧杆位移下运行未超过安全操纵界限时,控制模块3用于根据侧杆位移生成第一主动加载力矩,监控模块2以通过第一主动加载力矩生成力矩驱动指令,通过力矩电机13控制主动侧杆4的反向驱动力,以给予用户在使用该主动侧杆4控制时一定的反馈,以适应不同操纵人员对阻尼特性的需求。
当航行态势超出安全操纵界限时,增加额外的反驱力,使艇员感受到安全操纵界限的限制,提升水下载人航行器操纵安全。
也即,在水下载人航行器在当前侧杆位移下运行超过安全操纵界限时,控制模块3在第一主动加载力矩的基础上生成第二主动加载力矩,监控模块2以通过调整后的力矩驱动指令控制力矩电机13对反向驱动力进行调整,以在适应不同操纵人员对阻尼特性的需求的基础上,保证艇员做出正确的操纵行为。
安全操纵界限的工作原理如图5所示。安全操纵界限是在直角坐标上描述水下载人航行器的安全操纵态势。其中,横坐标由左到右表示航速的增加,纵坐标由上到下描述深度的增加,坐标平面上任一点对应着一种航行状态。
安全操纵界限的设计思路是,航行器以某航速在某深度航行时,当发生舵卡事件时,考虑到反应时间等因素,操艇控制系统进行应急挽回操纵使得航行器能够安全挽回的最大初始纵倾角度。每条包线包括两条界限,即下潜限制线和上浮限制线,用于对不同深度不同航速条件下的纵倾角进行限制。
对于艉舵角的限制,是基于航速范围进行设计的。通常分为低速区、中速区和高速区,在不同分区内艉舵角的最大许用舵角不同。
因此,图中的黑色实线代表不同航速下的安全航行的深度边界,同时对艉升降舵角也做了限制。
当水下载人航行器的航行态势未超过安全操纵界限时,力矩电机13通过侧杆位移生成的第一主动加载力矩,监控模块2以通过第一主动加载力矩生成力矩驱动指令,通过力矩电机13控制主动侧杆4的反向驱动力。
当水下载人航行器的航行态势超过安全操纵界限时,控制模块3在第一主动加载力矩的基础上生成第二主动加载力矩,监控模块2以通过调整后的力矩驱动指令控制力矩电机13对反向驱动力进行调整。
于是在主动模式下,主动侧杆作用于操纵人员人手的力矩计算如公式(1)所示:
其中,ω为主动侧杆的角位移速率,e为水下载人航行器超出安全操纵界限距离。k0,ke和kd为主动侧杆内置的力控制参数。
本实施例中,k0,ke和kd为根据用户设置的参数,在此情形下,使用者也可根据需要自由调整参数。
在另一实施例中,主动侧杆4内置的力控制参数包括k0,ke和kd,其中阻尼系数k0为安全操纵界限范围内的阻尼系数,ke为超出安全操纵界限后的力梯度系数,kd为超出安全操纵界限后的附加阻尼系数。这三个参数通过监控模块2内置人感系统模型,进行自适应调节,调节原理如下图所示。
参数调节的目标是使得驾驶员诱发振荡(Pilot Induced Oscillation,PIO)最小,驾驶员诱发振荡是由于特定的水下操纵任务,操艇人员被迫采取粗暴的操纵方式,发出快速往复操纵指令,从而引起控制指令的振荡。
基于实时PAC(Phase Aggression Criterion)准则进行PIO测定。PAC判定准则通过侧杆产生的操纵指令计算得到相位延迟P(公式(2))和迅猛因子A(公式(3))。
其中,Tr1和Tr2为单个航行器运动角速率响应的第1和第2个峰值的时刻。Tδ1和Tδ2分别为操纵周期中侧杆角位移第1个和第2个峰值的时刻。为侧杆操纵角位移对时间的导数。
反馈参数的自适应算法对迅猛因子A进行在线优化,调整力控制参数包括k0,ke和kd。通过自适应调节k0,ke和kd三组参数,该侧杆结构能够根据用户控制实时控制反馈力。
在一实施例中,如图2所示,单台主动侧杆4通常包括两个自由度,使得操纵人员可以前后和左右拉动侧杆,两个方向的运动相互独立。前后运动和左右运动的位移量被监控模块2测量,并最终下达到中央操纵控制计算机。另一方面,当主动侧杆4产生了超出安全操纵界限的指令时,中央操纵控制计算机产生反向驱动力指令,提醒操纵人员可能会发生操纵危险。
水下载人航行器通常会配置多套侧杆结构,通过操纵权限选择,可实现多人协同操纵。二自由度主动侧杆以及侧杆模块如图2所示。
具体而言,主动侧杆4为具有二自由度操纵杆;侧杆模块1还包括隔离结构14,转轴设有两个,分别为深度指令转轴15和航向指令转轴16,主动侧杆4与隔离结构14连接。
深度指令转轴15通过隔离结构14与主动侧杆4传动连接,用于反馈主动侧杆4所传递的深度指令;航向指令转轴16通过隔离结构14与主动侧杆4传动连接,用于反馈主动侧杆4所传递的航向指令。
杆力传感器12设有两个,分别为第一杆力传感器和第二杆力传感器。第一杆力传感器与深度指令转轴15连接,并通过监控模块2与控制模块3电连接,用于检测主动侧杆4沿深度方向受所述力矩电机驱动外力,并将沿深度方向的外力反馈信号通过监控模块2发送至控制模块3。第二杆力传感器与航向指令转轴连接,并通过监控模块2与控制模块3电连接,用于检测主动侧杆4沿航向方向受所述力矩电机驱动外力,并将沿航向方向的外力反馈信号通过监控模块2发送至控制模块3。由此,在力矩电机13调整反向驱动力的过程中,能够根据杆力传感器12检测到的力进行比较,以对反向驱动力进行适应性调整,保证输出的力在预设范围内。
对应地,力矩电机13设有两个,分别为第一力矩电机和第二力矩电机。第一力矩电机通过深度指令转轴15与主动侧杆4传动连接,用于沿深度方向控制主动侧杆4移动。第二力矩电机通过航向指令转轴16与主动侧杆4传动连接,用于沿航向方向控制主动侧杆4移动。
对应地,编码器11设有两个,分别为第一编码器和第二编码器。第一力矩电机与第一编码器电连接,第一编码器用于检测主动侧杆4沿深度方向的侧杆位移,用以将沿深度方向的侧杆位移通过监控模块2发送至控制模块3。第二力矩电机与第二编码器电连接,第二编码器用于检测主动侧杆4沿航向方向的侧杆位移,用以将沿航向方向的侧杆位移通过监控模块2发送至控制模块3。
在一个实施例中,如图3所示,侧杆模块1还包括:减速器17。减速器17与力矩电机13传动连接。减速器17与力矩电机13的转动轴相连,减速器17用于降低力矩电机13的输出转速,增加转矩,提升载荷能力,从而达到理想的传动效果,满足工作需求。
如图2和图3所示,侧杆模块1还包括:壳体18和轴承,轴承设置于壳体18,转轴19与轴承连接;主动侧杆4包括杆体41和手柄42;手柄42与杆体41连接,杆体41与杆力传感器12连接,杆体41通过转轴19与力矩电机13传动连接。
其中,杆力传感器12用于测量主动侧杆4对人手施加的操纵力;壳体18为上下开口的矩形框,轴承分别位于壳体18四壁中心上;转轴19下与轴承相连,转轴19上与杆体41相连;杆体41的下端与转轴相连,杆体41的上端与杆力传感器12相连。
主动侧杆4包括两个功能相互独立的单自由度侧杆。每个单自由度侧杆模块的原理如图3所示,转轴19与减速器17相连,减速器17与力矩电机13的转动轴相连,力矩电机13后方是编码器11。
基于上述实施例,在一些实施例中,如图4所示,监控模块2包括:旋转变压器21、电流传感器22、电机驱动模块23和监控控制器24。
本实施例中,力矩电机13的第一信号发送端通过旋转变压器21与监控控制器24电连接,力矩电机13的第二信号发送端通过电流传感器22与监控控制器24电连接;力矩电机13的信号接收端通过电机驱动模块23与监控控制器24电连接,监控控制器24与控制模块3电连接。
工作过程中,杆力传感器12用于主动侧杆4对人手施加的操纵力,并将外力通过监控控制器24发送至控制模块3。编码器11用于检测主动侧杆4的侧杆位移,旋转变压器21用于读取其中的杆位移信号,电流传感器22用于读取其中的驱动电机电流信号,杆位移信号和驱动电机电流信号均通过监控控制器24发送至控制模块3。控制模块3用于根据侧杆位移生成第一主动加载力矩,以通过监控控制器24生成力矩驱动指令控制传递至电机驱动模块23,电机驱动模块23控制力矩电机13控制主动侧杆4的反向驱动力。控制模块3在水下载人航行器在当前所述侧杆位移下运行超过安全操纵界限时,在第一主动加载力矩的基础上生成第二主动加载力矩,以通过监控控制器24生成力矩驱动指令控制力矩电机13对反向驱动力进行调整。
为便于连接旋转变压器21、电流传感器22以及杆力传感器12。监控模块2还包括:杆力信号调制电路25、位移信号调制电路26和电流信号调制电路27。杆力传感器12通过杆力信号调制电路25与监控控制器24电连接,旋转变压器21通过位移信号调制电路26与监控控制器24电连接,电流传感器22通过电流信号调制电路27与监控控制器24电连接。
其中,杆力信号调制电路25用于配合将杆力传感器12检测的信号传递至监控控制器24的AD模块中,位移信号调制电路26用于配合将旋转变压器21检测的信号传递至监控控制器24的AD模块中。电流信号调制电路27用于配合将电机驱动模块23检测的信号传递至监控控制器24的AD模块中。AD模块中的各信号通过串口发送至中央操纵控制计算机中。
该监控模块2,一方面根据航行安全包络线和运动参数,融合航行状态数据,产生力控制指令,驱动力矩电机,并作用到侧杆模块,使艇员通过力感受操纵态势;另一方面,可根据艇员操纵习惯,自适应调节侧杆刚度和阻尼特性,从而获得最为舒适的操纵感觉,提升人机工效。
在一实施例中,应用于水下载人航行器的侧杆结构设置有工作模式切换按钮,根据选择,侧杆结构包括三种工作模式,即主动模式,跟随模式和被动模式。
为了满足多个操纵位同时进行深度和航向的控制,通常需要配置多个侧杆结构,每个侧杆结构可设置不同的操纵模式。
在主动模式下,监控模块2产生力控制指令,并作用到侧杆模块,控制主动侧杆4,使艇员通过“力感”感受操纵态势;在随动模式下,操纵控制系统中央计算机产生操纵指令,主动侧杆4跟随内部指令产生位移,而不跟随操纵人员的指令;在被动模式下,主动侧杆4被动跟随操纵人员的操纵,不产生力反馈特性,也不产生内部杆位移指令。
主动侧杆4的左右操纵通常转为水下航行器的航向或方向舵操纵指令,前后推拉操纵通常转化为航行器的深度或升降舵操纵指令。结合操纵指令的形式和主动侧杆的操纵模式,水下航行器包括14种操纵模式,每一种模式可被分配到某个主动侧杆的一个自由度,每个主动侧杆4的一个自由度只能同时具有一个操纵模式;升降舵控制同时只能具有一个操纵模式,方向性舵控制同时只能具有一个操纵模式。14种操纵模式如下表1所示。
表1
在主动模式下,水下载人航行器安全包络线数据和航行态势将产生侧杆力反驱特性,使得侧杆的杆力变化能够提示艇员是否接近或超越了正常的航行包线范围,并引导艇员实施安全挽回操纵。
主动杆机械机构多余阻力的被自适应力控制算法进行补偿抵消,实现主动操作杆的力梯度、阻力特性的自适应调节技术;实现对上述参数的自适应修正,使得侧杆指令平稳、快速、准确。优化艇员操纵体验,降低操纵负荷,提升水下载人航行器操纵品质。
侧杆的指令最终转化为水下载人航行器的转舵指令。水下载人航行器包括三对舵面,即艉部竖直布置的方向舵,以及水平布置的艏升降舵和艉升降舵。方向舵用于控制水下载人航行器的水平运动和航向;艉升降舵和艏升降舵用于控制水下载人航行器的纵倾角和航行深度。
左右操纵下达的指令会转化为水下载人航行器的转向速率指令和方向舵转角指令。前后操纵主动侧杆的指令会转化为水下载人航行器的深度变化速率指令或艏升降舵转角指令。当前后推拉指令控制艏升降舵转角指令时,艉部升降舵的舵角控制指令由中央计算机生成并下达。
此外,本发明实施例还提供一种水下载人航行器,该水下载人航行器包括上述的侧杆结构。
该侧杆结构的结构可参阅图1至图4相关的文字描述,在此不再赘述。
综上所述,本发明实施例提供的应用于水下载人航行器的侧杆结构及水下载人航行器。侧杆结构可以根据水下载人航行器航行任务特点设置航行安全操纵界限和运动参数,融合航行状态数据,使艇员通过反向驱动力感受操纵态势,提升复杂任务环境下的操纵品质;另一方面,可根据艇员操纵习惯,自适应调节侧杆刚度和阻尼特性,从而获得最为舒适的操纵感觉,提升人机工效。
应用于水下载人航行器的侧杆结构具有多重应用价值,包括:
(1)有助于提升航行操纵安全。主动侧杆技术将安全操纵界限,航行状态等信息进行融合,反馈为侧杆反向驱动力,杆力变化能够提示艇员是否接近或超越了安全操纵范围,再通过仪表显示功能将状态更完整的传达给艇员,保证艇员做出正确的操纵行为。
(2)提升艇员操纵体验和人机工效。侧杆的控制算法,可实现对机构摩擦力补偿,并自适应调节侧杆的相应刚度、阻尼参数,从而调整操纵力感特性,降低操纵负荷,提升操纵体验。
(3)提升潜操系统控制品质。主动操纵技术,自适应调节技术将使得下达的舵杆指令更为平稳、准确和快速,将有效避免指令舵角、指令航向角、指令深度、指令变化速率等参数抖动,从而提升控制品质。
(4)有助于减员增效。主动操作杆技术将水下载人航行器多方面航行态势信息融合到杆位移和杆力中,从而实现单人操艇,减员增效。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (10)
1.一种应用于水下载人航行器的侧杆结构,其特征在于,包括:
主动侧杆、侧杆模块、监控模块和控制模块;
所述侧杆模块包括转轴、杆力传感器、力矩电机和编码器;
所述杆力传感器与所述主动侧杆连接,并通过所述监控模块与所述控制模块电连接,用于检测主动侧杆受所述力矩电机驱动外力,并将外力反馈信号通过所述监控模块发送至所述控制模块;
所述编码器与所述力矩电机电连接,并通过所述监控模块与所述控制模块电连接,所述编码器用于检测所述主动侧杆的侧杆位移,用以将所述侧杆位移通过所述监控模块发送至所述控制模块;
所述力矩电机通过所述转轴与所述主动侧杆传动连接,所述控制模块与所述力矩电机电连接,所述控制模块用于根据所述侧杆位移生成第一主动加载力矩,所述监控模块以通过所述第一主动加载力矩生成控制所述力矩电机控制所述主动侧杆的反向驱动力,并在水下载人航行器在当前所述侧杆位移下运行超过安全操纵界限时,所述控制模块在第一主动加载力矩的基础上生成第二主动加载力矩,所述监控模块以通过所述第二主动加载力矩控制所述力矩电机对所述反向驱动力进行调整。
2.根据权利要求1所述的应用于水下载人航行器的侧杆结构,其特征在于,所述主动侧杆为具有二自由度操纵杆;
所述侧杆模块还包括隔离结构,所述转轴设有两个,分别为深度指令转轴、航向指令转轴,所述主动侧杆与所述隔离结构连接;
所述深度指令转轴通过所述隔离结构与所述主动侧杆传动连接,用于反馈所述主动侧杆所传递的深度指令;
所述航向指令转轴通过所述隔离结构与所述主动侧杆传动连接,用于反馈所述主动侧杆所传递的航向指令。
3.根据权利要求2所述的应用于水下载人航行器的侧杆结构,其特征在于,所述杆力传感器设有两个;
其中一所述杆力传感器与所述深度指令转轴连接,并通过所述监控模块与所述控制模块电连接,用于检测主动侧杆沿深度方向受所述力矩电机驱动外力,并将沿深度方向的外力反馈信号通过所述监控模块发送至所述控制模块;
另一所述杆力传感器与所述航向指令转轴连接,并通过所述监控模块与所述控制模块电连接,用于检测主动侧杆沿航向方向受所述力矩电机驱动外力,并将沿航向方向的外力反馈信号通过所述监控模块发送至所述控制模块。
4.根据权利要求3所述的应用于水下载人航行器的侧杆结构,其特征在于,所述力矩电机设有两个;
其中一所述力矩电机通过所述深度指令转轴与所述主动侧杆传动连接;
另一所述力矩电机通过所述航向指令转轴与所述主动侧杆传动连接。
5.根据权利要求4所述的应用于水下载人航行器的侧杆结构,其特征在于,所述编码器设有两个;
其中一所述力矩电机与其中一所述编码器电连接,其中一所述编码器用于检测所述主动侧杆沿深度方向的侧杆位移,用以将沿深度方向的所述侧杆位移通过所述监控模块发送至所述控制模块;
另一所述力矩电机与另一所述编码器电连接,另一所述编码器用于检测所述主动侧杆沿航向方向的侧杆位移,用以将沿航向方向的所述侧杆位移通过所述监控模块发送至所述控制模块。
6.根据权利要求1所述的应用于水下载人航行器的侧杆结构,其特征在于,所述侧杆模块还包括:减速器;所述减速器与所述力矩电机传动连接。
7.根据权利要求1所述的应用于水下载人航行器的侧杆结构,其特征在于,所述侧杆模块还包括:壳体和轴承,所述轴承设置于所述壳体,所述转轴与所述轴承连接;所述主动侧杆包括杆体和手柄;所述手柄与所述杆体连接,所述杆体与所述杆力传感器连接,所述杆体通过所述转轴与力矩电机传动连接。
8.根据权利要求1所述的应用于水下载人航行器的侧杆结构,其特征在于,所述监控模块包括:
旋转变压器、电流传感器、电机驱动模块和监控控制器;
所述力矩电机的第一信号发送端通过所述旋转变压器与所述监控控制器电连接,所述力矩电机的第二信号发送端通过所述电流传感器与所述监控控制器电连接;
所述力矩电机的信号接收端通过所述电机驱动模块与所述监控控制器电连接,所述监控控制器与所述控制模块电连接。
9.根据权利要求8所述的应用于水下载人航行器的侧杆结构,其特征在于,所述监控模块还包括:
杆力信号调制电路、位移信号调制电路和电流信号调制电路;
所述杆力传感器通过所述杆力信号调制电路与所述监控控制器电连接,所述旋转变压器通过所述位移信号调制电路与所述监控控制器电连接,所述电流传感器通过所述电流信号调制电路与所述监控控制器电连接。
10.一种水下载人航行器,其特征在于,包括如权利要求1-9中任一项所述的侧杆结构。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311702430.3A CN117991834A (zh) | 2023-12-12 | 2023-12-12 | 一种应用于水下载人航行器的侧杆结构及水下载人航行器 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311702430.3A CN117991834A (zh) | 2023-12-12 | 2023-12-12 | 一种应用于水下载人航行器的侧杆结构及水下载人航行器 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN117991834A true CN117991834A (zh) | 2024-05-07 |
Family
ID=90890305
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202311702430.3A Pending CN117991834A (zh) | 2023-12-12 | 2023-12-12 | 一种应用于水下载人航行器的侧杆结构及水下载人航行器 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN117991834A (zh) |
-
2023
- 2023-12-12 CN CN202311702430.3A patent/CN117991834A/zh active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7565876B2 (en) | Marine vessel control system | |
EP1937550B1 (en) | Steering system for a marine vessel | |
US7404369B2 (en) | Watercraft steer-by-wireless system | |
US8113892B1 (en) | Steering control system for a watercraft with three or more actuators | |
EP3287862A1 (en) | Method for steering an underactuated ship | |
EP2716541A2 (en) | Boat propulsion system and method for controlling boat propulsion unit | |
US20220041267A1 (en) | System and Method of VTOL Vehicle Flight Control Inceptors | |
JP2016074250A (ja) | 操船システム | |
US6694230B2 (en) | Aircraft with electrical fly-by-wire controls, equipped with an automatic pilot | |
JP2022179145A (ja) | 船舶推進制御システム及び船舶 | |
CN113359785A (zh) | 一种微小型auv水下运动和悬停控制方法 | |
EP3406516B1 (en) | Ship maneuvering device and ship provided therewith | |
US11021220B2 (en) | Boat maneuvering support device | |
JP7249657B2 (ja) | 船舶の制御法 | |
EP3006327B1 (en) | A control system for a ship | |
EP4309997A1 (en) | Marine propulsion system and joystick control method | |
CN117991834A (zh) | 一种应用于水下载人航行器的侧杆结构及水下载人航行器 | |
CN117930643A (zh) | 一种应用于水下载人航行器的侧杆结构控制方法 | |
CN117970792A (zh) | 一种水下载人航行器的侧杆结构控制方法 | |
JP2015063181A (ja) | 姿勢角制御装置 | |
JP5151168B2 (ja) | バウスラスタと旋回式スラスタを有する2軸船の推力制御方法及び装置 | |
JP3615985B2 (ja) | 操船装置 | |
WO2023048177A1 (ja) | 船舶操縦システム | |
EP4300242A1 (en) | A motion control system and controllers for a marine vessel | |
JP2004352007A (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 |