一种无人潜器操控装置及控制方法
【技术领域】
[0001] 本发明涉及的是一种无人潜器操控装置，尤其是涉及一种无人潜器地面远程操控 装置。本发明也涉及一种无人潜器操控方法。
【背景技术】
[0002] 21世纪，随着人类不断认识海洋、开发利用海洋资源和保护海洋的进程，无人潜器 (Unmanned Underwater Vehicle)这一高新技术得到迅速发展，其被认为是成功完成各种 水下任务希望之星。目前无人潜器成功应用于海底地形地貌勘察、海洋资源及地质调查、海 洋环境和水文参数测量、生物考察等任务中。无人潜器安装的设备，或是独一无二的，或是 相当昂贵的，在任务过程中采集的数据也是十分重要的。设计开发一套稳定可靠、高效安全 的无人潜器操控系统显得尤为重要。
[0003]目前大多数操控系统只是基于软件实现无人潜器的操纵控制或者只是加入简单 的操纵手柄，实现无人潜器的操纵与控制，这些系统存在人机交互性差、稳定性低、系统性 不强等特点。以往的操控系统中，故障下无人潜器的操作完全根据操作员的经验来实现，不 能够完全科学地进行故障状态下的强力挽回，且操作员经验有限。所以开发一套具有应付 突发事件，能在故障状态强力挽回，即拥有智能抗沉能力的无人潜器操控装置具有实际的 工程价值。
【发明内容】
[0004] 本发明的目的在于提出一种通用性好、稳定性高、易于实现、实用性强、成本低廉 且具有智能抗沉能力的无人潜器操控装置。本发明的目的还在于提供一种无人潜器控制方 法。
[0005] 本发明的无人潜器操控装置包括两个显示器、工控机、操控单元和网络模块；第一 显示器与工控机通过HDMI连接线连接，用于显示操控界面及当前的无人潜器操控指令；第 二显示器通过VGA视屏线与工控机连接，用于三维显示无人潜器的运动状态及列表显示其 状态信息；工控机读取操控单元操作员的操控指令，通过网络模块发送执行器指令信息给 无人潜器，同时在第一显示器显示；无人潜器接受执行器指令的同时，将艇内传感器的信息 和艇内各设备工作情况通过网络发送到工控机，用于进行下一节拍的解算或者信息输入； 所述操控单元由按钮开关、单双色指示灯、操纵杆和电位器组成，操控单元通过隔离信号板 经USB接口、串口和DIO卡与工控机连接来获取操作员操纵指令的功能。
[0006] 本发明的无人潜器操控装置还可以包括：
[0007] 1、第二显示器与第一显示器成106°夹角，第二显示器位于最上方，操控单元位于 中部，工控机和网络模块置于柜体中。
[0008] 2、所述操控单元主要由指示、按钮开关，3个单轴双方向霍尔型操纵杆、速度电位 器、轨迹球和工业数字小键盘组成，指示灯有单色灯和双色灯，单色用于显示控制方式、控 制策略以及当前操作状态，双色灯用于显示设备是否正常工作，按钮开关用于设备供电、控 制方式选择和控制策略选择等的操作，操纵杆用于舵角的输入，速度电位器用于输入推进 器的转速输入。
[0009] 3、所述隔离信号板包括继电器、串口模块、AD采集模块、隔离电源和数字隔离芯片 ADUM1401，操纵杆和电位器经串口模块连接数字隔离芯片ADUM1401，单双色指示灯经继电 器连接数字隔离芯片ADUM1401。
[0010] 本发明的无人潜器控制方法，主要包括以下步骤：
[0011] 1)操控装置与无人潜器通过网络模块建立网络连接，
[0012] 2)发送指令实现无人潜器各任务设备供电，
[0013] 3)操控单元选择控制方式及控制策略，输入相关操控指令，
[0014] 4)操纵控制模块根据操控指令和获得的无人潜器状态信息生成执行器指令，
[0015] 5)通过网络模块发送执行器指令至无人潜器，无人潜器开始工作，
[0016] 6)重复步骤 2)-5);
[0017] 步骤3)中控制方式包括自动控制与手动控制，所述手动控制是直接从控制单元 输入控制指令，经网络模块与无人潜器建立网络连接，进行传输；所述自动控制是根据操 控单元输入的目标指令和获取的无人潜器状态信息，利用控制算法解算得到实时执行器指 令，传输至无人潜器运动；
[0018] 步骤4)中生成执行器指令的过程主要分为三种，既手动控制时执行器指令，自动 控制时执行器指令和智能抗沉执行器智力：
[0019] 步骤4)中手动控制时执行器指令的获取直接通过工控机中与信号隔离板直接获 得操控单元的执行器指令。
[0020] 步骤4)中自动控制时生成执行器指令的过程主要为自动控制过程和推力分配过 程，其中自动控制采用参数自适应S面控制，其S面曲线如下：
[0021]
[0022] 其中：
[0023] Y⑴为输出，无因次化量；
[0024] e和ee为偏差和偏差变化率，归一化处理；
[0025] ke和kv为偏差控制参数和偏差变化率控制参数。
[0026] 其中ke和kv会根据无人潜器的基本参数和自动控制目标进行选取。相同的自动 控制目标，不同的无人潜器具有不同的控制参数；同一无人潜器，不同的自动控制目标具有 不同的控制参数。
[0027] 步骤4)中的自动控制过程，包含以下过程：
[0028] SOl :根据设定的目标值和该时刻无人潜器的状态及上一时刻偏差变化量Δ e，计 算此刻的偏差值e，判断若e在允许范围内，则保持此刻状态不变，否则由上一时刻变化量 Δ e/t求得此刻的偏差变化率ee ;
[0029] S02 :e及ee进行无因次化：将e/emax、ee/eemax无因次化得e'、ee'，并将无因次 化后所得的 ^ 和 ee'，若 ee' >1，取 ee' =1，若 ee' <-1，取 ee' =-1;
[0030] S03 :根据控制目标和无人潜器基本参数选择控制参数kp k2;
[0031] S04:根据S面曲线求解控制力P ;
[0032] S05:将控制力矩P有因次化？_·^得F，并将F输出。
[0033] 其中，Fniax为控制系统一个节拍内能产生的最大控制力矩，e _、θθ_为在最大控制 力下能改变的最大偏差及产生的最大偏差变化率；推力分配过程是根据自动控制过程中得 到的控制力矩/力结算得到执行器指令，包括推进器转速、舵角、水舱栗阀开关；
[0034] 步骤4)中当发生破舱故障时，潜器舱内进水，重力大于浮力引起非正常下潜，此 时智能抗沉生成执行器指令的过程，主要包括：
[0035] S06 :破舱故障发生时，采集故障信息；
[0036] S07 :根据采集的故障信息，进行高压吹除位置选择和进行抗沉策略选择；
[0037] S08 :根据S07中的选择，进行智能解算；
[0038] S09 :推力分配，生成执行器指令。
[0039] 其中，步骤S07中，主要采集的故障信息为破舱故障发生的位置和故障发生时无 人潜器所处的深度信息；
[0040] 步骤S08中，高压吹除的位置主要为破舱的位置，其中智能抗沉策略包括保持当 前航行深度和立即紧急上浮；
[0041 ] 步骤S08中，自动控制解算是根据步骤S07中的策略，求解一个时间节拍内控制力 矩/力。
[0042] 步骤S09中，推力分配产生的执行器指令主要包括车舵信息，即推进器转速和舵 角，高压吹除信息。
[0043] 本发明的无人潜器操控装置主要包括两个显示器、工控机、操控单元和网络模块。 第一显示器，与工控机通过HDMI (-种视频连接线）连接线连接，用于显示操控界面及当前 的无人潜器操控指令；第二显示器，通过VGA (-种视频连接线）视屏线与所述工控机连接， 用于三维显示无人潜器的运动状态及列表显示其状态信息，实现对无人潜器的监控；所述 工控机通过内置的驱动程序读取操控单元操作员的操控指令，通过网络模块发送执行器指 令信息给无人潜器，实现无人潜器的运动控制与任务设备的操控，同时在操控显示器显示； 另一方面，无人潜器接受执行器指令的同时，将艇内传感器的信息和艇内各设备工作情况 通过网络发送到工控机，以便进行下一节拍的解算或者信息输入；所述操控单元由按钮开 关、单双色指示灯、操纵杆和电位器等组成，通过隔离信号板，经USB接口、串口和DIO卡与 工控机连接来获取操作员操纵指令的功能。
[0044] 基于无人潜器操控装置的无人潜器操控实现方法，可通过操控单元按钮单独实现 控制方式和控制策略的选择，也可以通过内置的软件单独实现，但两者信息同步更新。无人 潜器运动具有很强的非线性，在自动控制方式中，采用S面控制模型，很好地处理无人潜器 非线性问题。在实现过程中，加入了智能抗沉模块，适合破舱故障状态下有效地挽回。
[0045] 与已有技术相对比本发明具有如下优越性：
[0046] 1、采用两个显示器进行显示：一台显示操控界面及当前的无人潜器操控指令，另 一台三维显示无人潜器的运动状态及列表显示其状态信息，实现对无人潜器的监控。
[0047] 2、具有智能抗沉能力，在破舱故障状态下可有效地进行挽回。
[0048] 本发明通用性好、稳定性高、易于实现、实用性强、成本低廉且具有智能抗沉能力。
【附图说明】
[0049] 图1是无人潜器操控装置硬件组成示意图。
[0050] 图2是无人潜器操控装置外观图。
[0051 ] 图3是操控单元示意图。
[0052] 图4是隔离信号板工作原理示意图。
[0053] 图5是无人潜器操控实现方式流程图。
[0054] 图6是自动控制原理流程图。
[0055] 图7是智能抗沉原理图。
【具体实施方式】
[0056] 下面结合附图对本发明作进一步说明。
[0057] 结合图1，本发明的无人潜器操控装置包括两个显示器、工控机3、操控单元和网 络模块5。第一显示器1，与工控机3通过HDMI (-种视频连接线）连接线连接，用于显示操 控界面及当前的无人潜器操控指令；第二显示器2,通过VGA (-种视频连接线）视屏线与 工控机3连接，用于三维显示无人潜器的运动状态及列表显示其状态信息，实现对无人潜 器的监控；工控机3通过内置的驱动程序读取操控单元操作员的操控指令，通过网络模块 5发送执行器指令信息给无人潜器，实现无人潜器的运动控制与任务设备的操控，同时在第 一显示器1显示；另一方面，无人潜器将艇内传感器的信息和艇内各设备工作情况通过网 络发送到工控机3,以便进行下一节拍的执行器指令解算或操控指令输入；操控单元上输 入设备通过隔离信号板7经USB、串口和DIO卡与工控机3连接，实现操控指令获取；网络 模块5与工控机3中内置的网卡相连接，实现与无人潜器建立网络连接，为数据传输提供保 障。
[0058] 结合图2,第二显示器2布置在无人潜器操控装置最上方部位，与第一显示器1成 106 °夹角，操控单元通过8个M6螺丝并紧安装在无人潜器操控装置中部，工控机和网