CN113147438A - 一种水下航行器无线充电系统及控制方法 - Google Patents

一种水下航行器无线充电系统及控制方法 Download PDF

Info

Publication number
CN113147438A
CN113147438A CN202110475814.0A CN202110475814A CN113147438A CN 113147438 A CN113147438 A CN 113147438A CN 202110475814 A CN202110475814 A CN 202110475814A CN 113147438 A CN113147438 A CN 113147438A
Authority
CN
China
Prior art keywords
underwater vehicle
wireless charging
module
matrix
control
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.)
Granted
Application number
CN202110475814.0A
Other languages
English (en)
Other versions
CN113147438B (zh
Inventor
夏涛
刘亮
李天伊
刘禹含
孟高军
李建林
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing Institute of Technology
Original Assignee
Nanjing Institute of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing Institute of Technology filed Critical Nanjing Institute of Technology
Priority to CN202110475814.0A priority Critical patent/CN113147438B/zh
Priority claimed from CN202110475814.0A external-priority patent/CN113147438B/zh
Publication of CN113147438A publication Critical patent/CN113147438A/zh
Application granted granted Critical
Publication of CN113147438B publication Critical patent/CN113147438B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L53/00—Methods of charging batteries, specially adapted for electric vehicles; Charging stations or on-board charging equipment therefor; Exchange of energy storage elements in electric vehicles
    • B60L53/10—Methods of charging batteries, specially adapted for electric vehicles; Charging stations or on-board charging equipment therefor; Exchange of energy storage elements in electric vehicles characterised by the energy transfer between the charging station and the vehicle
    • B60L53/12—Inductive energy transfer
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L53/00—Methods of charging batteries, specially adapted for electric vehicles; Charging stations or on-board charging equipment therefor; Exchange of energy storage elements in electric vehicles
    • B60L53/30—Constructional details of charging stations
    • B60L53/34—Plug-like or socket-like devices specially adapted for contactless inductive charging of electric vehicles
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L53/00—Methods of charging batteries, specially adapted for electric vehicles; Charging stations or on-board charging equipment therefor; Exchange of energy storage elements in electric vehicles
    • B60L53/30—Constructional details of charging stations
    • B60L53/35—Means for automatic or assisted adjustment of the relative position of charging devices and vehicles
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
    • B63H—MARINE PROPULSION OR STEERING
    • B63H21/00—Use of propulsion power plant or units on vessels
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60L—PROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2200/00—Type of vehicles
    • B60L2200/32—Waterborne vessels
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/60—Other road transportation technologies with climate change mitigation effect
    • Y02T10/70—Energy storage systems for electromobility, e.g. batteries
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/60—Other road transportation technologies with climate change mitigation effect
    • Y02T10/7072—Electromobility specific charging systems or methods for batteries, ultracapacitors, supercapacitors or double-layer capacitors
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
    • Y02T90/10—Technologies relating to charging of electric vehicles
    • Y02T90/12—Electric charging stations
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
    • Y02T90/10—Technologies relating to charging of electric vehicles
    • Y02T90/14—Plug-in electric vehicles

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Power Engineering (AREA)
  • Transportation (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Ocean & Marine Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种水下航行器无线充电系统及控制方法，所述系统包括海上发电平台、水下航行器和无线充电接收器；航行器包括接收器运动控制模块、动态定位模块、控制模块、整流滤波电路和系统电源；无线充电接收器与海上发电平台的发射端通过强磁耦合，产生变化电流传输至整流滤波电路，对系统电源进行充电；接收器运动控制模块调整无线充电接收器的位置和角度；动态定位模块保持航行器在水中的位置及方向；控制模块控制各模块的运行，以保持接收线圈与发射线圈间的相对位置。本发明通过水下航行器的状态保持、接收端实时追踪，实现更加高效的水下无线充电，解决在海水介质以及洋流及模型不确定的影响下，水下无线充电效率低的问题。

Description

一种水下航行器无线充电系统及控制方法
技术领域
本发明属于水下无线充电技术领域，具体涉及一种水下航行器无线充电系统及控制方法。
背景技术
由于海洋蕴藏着大量的自然资源和矿产资源，加上陆地资源的枯竭，近年来海洋资源的开发日益发达。随着深海活动的发展，水下航行器在海洋安全、海洋经济与科学、海洋考古、救援与军事等方面有着广泛的应用。此外，水下航行器是一种智能运动平台，可以在真实的海洋环境中依靠遥控或自主安全导航，完成管道检测、环境监测、水下搜救、海洋油气勘探开发等多种任务。
为了满足上述需求，需要水下航行器具有长时间续航的能力。在既不增加储能装置重量，又满足水下设备的密封性能的情况下，只能采用非接触式的无线充电技术。但在水下作业时，水下航行器总是受到洋流和模型不确定性等干扰的影响，发射线圈与接收线圈无法保持相对稳定位置来取得最佳的传输效率，导致充电速度慢，传输效率低等问题。
发明内容
本发明所要解决的技术问题是针对上述现有技术的不足，提供一种水下航行器无线充电系统及控制方法，能够在洋流影响下，使无线充电系统发射线圈与接收线圈保持相对稳定的位置关系，解决了水下充电效率低下的问题。
为实现上述技术目的，本发明采取的技术方案为：
一种水下航行器无线充电系统，包括海上发电平台、潜于海面以下的水下航行器和海平面以上的无线充电接收器；
所述航行器包括接收器运动控制模块、动态定位模块、控制模块、整流滤波电路和系统电源；
所述无线充电接收器与海上发电平台的发射端通过强磁耦合，产生变化电流传输至整流滤波电路，对系统电源进行充电；
所述接收器运动控制模块，用于调整无线充电接收器的位置和角度；
所述动态定位模块，用于保持航行器在水中的位置及方向；
所述控制模块，用于根据无线充电接收器和航行器反馈的状态信号控制各模块的运行，以保持接收线圈与发射线圈间的相对位置。
为优化上述技术方案，采取的具体措施还包括：
上述的接收器运动控制模块采用由舵机驱动的追踪机械臂，将无线充电接收器提升至海平面以上并实时调整无线充电接收器的状态。
上述的动态定位模块包括坐标定位模块、动力驱动模块与动态定位控制模块，动力驱动模块由四个水平推进器构成，动态定位控制模块分为运动控制器模块和动力分配模块；
坐标定位模块反馈海上发电平台与水下航行器的相对位置；
根据海上发电平台与水下航行器的相对位置，运动控制模块计算水下航行器控制律；
动力分配模块根据水下航行器控制律进行动力驱动模块的推进器的力和力矩分配，使航行器接近海上发电平台，达到功率消耗最小化；
根据海上发电平台与水下航行器的相对位置，接收器运动控制模块通过追踪机械臂对接收线圈状态进行微调，达到最优的传输效率。
上述的一种水下航行器无线充电系统的控制方法，包括：
控制模块控制动态定位模块获取海上发电平台与水下航行器的相对位置，
根据海上发电平台与水下航行器的相对位置，动态定位模块的运动控制模块计算水下航行器控制律；
动态定位模块的动力分配模块根据水下航行器控制律进行动力驱动模块的推进器的力和力矩分配，使航行器接近海上发电平台，达到功率消耗最小化；
接收器运动控制模块根据海上发电平台与水下航行器的相对位置调整无线充电接收器的位置和角度，达到最优的传输效率；
无线充电接收器与海上发电平台的发射端通过强磁耦合，产生变化电流传输至整流滤波电路，对系统电源进行充电。
上述的运动控制模块采用滑模控制计算水下航行器控制律，其设计过程具体为：
步骤1、构建水下航行器在地球固定坐标系(EF)下的动力学模型方程：
Figure BDA0003047051080000021
其中，向量η＝[x y ψ]T表示水下航行器在EF坐标系中的线性位置x、y和欧拉角ψ，
Figure BDA0003047051080000024
为η的一阶微分，
Figure BDA0003047051080000023
为η的二阶微分，系统矩阵ME、CE、DE、GE和τE如下：
Figure BDA0003047051080000031
其中，旋转矩阵J(ψ)是航向角函数，J-1(ψ)表示J(ψ)的逆矩阵，J-T(ψ)表示J(ψ)的转置逆矩阵，M为惯性矩阵、C(vr)表示向心力和科里奥利矩阵、D(vr)表示阻尼矩阵、G(η)表示重力，τ表示控制输入，vr表示洋流影响下水下航行器的相对速度。
步骤2、设ηd＝[xd yd ψd]为水下航行器的期望位置，定义跟踪误差：
e(t)＝ηd-η (24)
关于时间的微分，等式(24)变成：
Figure BDA0003047051080000032
引入滑模面函数为：
Figure BDA0003047051080000033
其中，∧是恒定控制增益，为对角正矩阵。
步骤3、根据滑模控制器设计策略，构造水下航行器的控制律τ：
τ＝τeq+τsw (27)
式中，τeq是将系统状态合并到滑动面的等效项，τsw是补偿不确定性和干扰影响的开关项；
等效控制τeq和开关控制τsw为：
Figure BDA0003047051080000034
τsw＝-βSgn(s) (29)
其中，
Figure BDA0003047051080000035
表示系统矩阵X的估计矩阵，X代表矩阵ME、CE、DE、GE,Fdis表示外部扰动，β是增益的正定矩阵，滑动面的符号函数用Sgn(s)表示：
Figure BDA0003047051080000036
步骤4、根据等式(28)和(29)，式(27)中水下航行器的鲁棒滑模控制定律重写如下：
Figure BDA0003047051080000037
用饱和函数替换符号函数，如下所示：
Figure BDA0003047051080000041
其中，Ф是为了引进边界层而给出的边界，式(31)中的滑模控制定律为：
Figure BDA0003047051080000042
上述的动力分配模块采用基于拉格朗日乘子的线性二次型控制分配方法进行动力分配，其设计过程包括以下步骤：
步骤一、等效控制输入τ和实际推力器动作U之间的关系假设为线性模型，其形式如下：
τ＝TU (35)
其中，矩阵T不是方阵，并且具有全行秩和/或非平凡零空间，则存在满足等式(35)的无限多个控制向量U；
步骤二、采用了摩尔-彭若斯广义逆方法，首先，定义最小二乘成本函数：
U*＝argmin(UTWU) (36)
其中，W是加权推进器成本的正定矩阵。式(36)表示动力分配将寻求实现期望广义力τ的解，同时最小化目标函数UTWU表示的控制力；argmin(UTWU)是指使得函数UTWU取得其最小值的所有自变量U的集合。
接下来，二次能量函数为：
Figure BDA0003047051080000043
根据以下条件最小化：
τ-TU＝0 (38)
则选择拉格朗日函数表示为：
Figure BDA0003047051080000044
其中，λ表示拉格朗日乘数。
步骤三、方程(39)对U进行微分，得到以下方程：
Figure BDA0003047051080000045
步骤四、根据公式(38)，公式(40)重写为：
τ＝TW-1TTλ (41)
得到拉格朗日乘法的最优解如下：
λ＝(TW-1TT)-1τ (42)
将式(42)代入式(41)，广义逆
Figure BDA0003047051080000046
产生如下：
Figure BDA0003047051080000051
因此，利用式(43)，实际推力器动作U计算为：
Figure BDA0003047051080000052
本发明具有以下有益效果：
(1)采用机械臂来实时调整无线充电接收端与发射端的相对位置，所采用的机械臂有结构轻、载重/自重比高等特性,因而具有较低的能耗、较大的操作空间和很高的效率,其响应快速而准确。在海平面以上进行电能无线传输，也避免海水介质的影响。
(2)采用滑模控制策略设计控制系统，在模型不确定性、系统参数变化、外部干扰等方面具有优良的品质特性、鲁棒性以及良好的动态和稳态响应。
(3)控制分配模块采用基于拉格朗日乘子的线性二次型方法有助于将滑模定律计算得到的广义力和力矩分配给推进系统的各个推进器，从而使整个系统消耗的功率最小。
(4)通过水下航行器的状态保持、接收端实时追踪，实现更加高效的水下无线充电，解决在海水介质以及洋流及模型不确定的影响下，水下无线充电效率低的问题。
附图说明
图1是水下航行器无线充电系统的结构示意图。
图2是水下航行器定位采用的坐标系示意图。
图3是水下航行器动力驱动模块四个推进器位置示意图。
图4是动力定位原理框图。
具体实施方式
以下结合附图对本发明的实施例作进一步详细描述。
如图1所示，本发明一种水下航行器无线充电系统，包括海上发电平台、潜于海面以下的水下航行器和海平面以上的无线充电接收器；
所述航行器包括接收器运动控制模块、动态定位模块、控制模块、整流滤波电路和系统电源；
本发明无线充电系统采用磁耦合谐振式无线传能技术，所述无线充电接收器与海上发电平台的发射端通过强磁耦合，产生变化电流传输至整流滤波电路，对系统电源进行充电；
所述接收器运动控制模块，用于调整无线充电接收器的位置和角度；
所述动态定位模块，用于保持航行器在水中的位置及方向；
所述控制模块，用于根据无线充电接收器和航行器反馈的状态信号控制各模块的运行，以保持接收线圈与发射线圈间的相对位置。
本发明控制模块采用基于滑模控制理论的鲁棒状态保持控制算法，以保证水下航行器在洋流扰动时的稳定性；还设计了一种动力优化分配控制算法，使系统的能量消耗最小。
本发明实现了更加高效的水下无线充电，减轻洋流、暗涌等的影响，从而保证水下航行器的充电效率。
实施例中，所述接收器运动控制模块采用由舵机驱动的追踪机械臂，将无线充电接收器提升至海平面以上并实时调整无线充电接收器的状态。
实施例中，所述动态定位模块包括坐标定位模块、动力驱动模块与动态定位控制模块，动力驱动模块由四个水平推进器构成，动态定位控制模块分为运动控制器模块和动力分配模块；
坐标定位模块反馈海上发电平台与水下航行器的相对位置；
根据海上发电平台与水下航行器的相对位置，运动控制模块计算水下航行器控制律；
动力分配模块根据水下航行器控制律进行动力驱动模块的推进器的力和力矩分配，使航行器接近海上发电平台，达到功率消耗最小化；
根据海上发电平台与水下航行器的相对位置，接收器运动控制模块通过追踪机械臂对接收线圈状态进行微调，达到最优的传输效率。
一种水下航行器无线充电系统的控制方法，包括：
控制模块控制动态定位模块获取海上发电平台与水下航行器的相对位置，
根据海上发电平台与水下航行器的相对位置，动态定位模块的运动控制模块计算水下航行器控制律；
动态定位模块的动力分配模块根据水下航行器控制律进行动力驱动模块的推进器的力和力矩分配，使航行器接近海上发电平台，达到功率消耗最小化；
接收器运动控制模块根据海上发电平台与水下航行器的相对位置调整无线充电接收器的位置和角度，达到最优的传输效率；
无线充电接收器与海上发电平台的发射端通过强磁耦合，产生变化电流传输至整流滤波电路，对系统电源进行充电。
如图2所示，水下航行器的动力模型由两部分组成，一部分是运动学模型，另一部分是动力学模型。使用两个坐标系：一个是坐标系(BF)固定在水下航行器上以定义其平移和旋转运动，另一个坐标系位于地球固定坐标系(EF)上以描述其位置和方向。本发明中，EF坐标系的原点固定在水面上，Z轴方向指向水下，X轴和Y轴方向构成右手坐标系。BF坐标系的原点位于水下航行器的重心，其中x、y、z轴分别指向HAUV的前方、右舷和下方。
观测变量η表示航行器在EF坐标系中的位置与姿态，用BF坐标系坐标原点在EF坐标系中的坐标(x，y，z)表示航行器在EF坐标系中的位置，同时用EF坐标系与BF坐标系之间的欧拉角(Ф，θ，ψ)表示航行器的姿态。
状态变量v表示航行器的BF坐标系线速度和角速度，其中(u，v，w)表示航行器的线速度，(p，q，r)表示航行器绕各轴旋转的角速度。
在讨论航行器的水平运动时，忽略垂荡、横摇和纵摇三种运动，即w＝p＝q＝0。
HAUV在水平面上的运动可以描述如下：
η＝[x y ψ]T：HAUV在EF坐标系中的线性位置x、y和欧拉角Ψ。
v＝[u v r]T：HAUV在BF坐标系下的线速度u、v和角速度r。
BF坐标BxByBzB和EF坐标EXEYEZE之间的三自由度关系可描述如下：
Figure BDA0003047051080000071
式中，旋转矩阵J(η)＝J(ψ)是HAUV航向角的函数，定义如下：
Figure BDA0003047051080000072
水下航行器的运动学方程可以重新排列为：
Figure BDA0003047051080000073
将体坐标系BF中的前进线速度u、侧移线速度v、艏摇角速度r变换到地坐标系EF中，得到X轴上速度
Figure BDA0003047051080000074
Y轴上速度
Figure BDA0003047051080000075
及艏摇角速度
Figure BDA0003047051080000076
通过减少HAUV在垂直平面运动中的垂荡、横摇和俯仰三种运动，BF框架中的水平运动动力学方程可以表示为：
Figure BDA0003047051080000077
其中，惯性矩阵M＞0，M＝MRB+MA，MRB是航行器的刚体质量矩阵，MA是附加质量矩阵；向心力和科氏力矩阵C(v)，C(v)＝CRB(v)+CA(v)，CRB(v)是刚体科氏力和向心力矩阵，CA(v)是附加质量科氏力和向心力矩阵；流体阻尼矩阵D(v)，D(v)＝DL+DNL(v)，DL为线性阻尼，DNL(v)为非线性阻尼；表示重力G(η)，可以假设重力在水平面上可以忽略不计，因此，G(η)＝0；τ为控制输入。
式中，所有矩阵M、C(v)和D(v)可表示为：
Figure BDA0003047051080000081
m为水下航行器质量，xg和yg为水平面上的航行器的重心位置，IZZ为绕Z轴的转动惯量。矩阵中
Figure BDA0003047051080000082
表示A对下标x方向上的附加质量，定义为
Figure BDA0003047051080000083
例如
Figure BDA0003047051080000084
其他类似。
Figure BDA0003047051080000085
Figure BDA0003047051080000091
矩阵中带下标的元素与矩阵MA中的元素的意义相同，例如
Figure BDA0003047051080000092
其他类似。
向量τ表示外力及外力矩作用，不包括环境干扰，τ＝[τXτYτN]。
水下航行器运动的三自由度方程的展开形式：
Figure BDA0003047051080000093
如图3所示，动力驱动模块由四个水平推进器构成，通过将这些水平推进器以固定倾角θT安装在水下航行器的船首和船尾部分，水下航行器的浪涌、摇摆和偏航运动可同时进行。
矩阵形式的水平推进器分配可定义如下：
τv＝TU (9)
式中，τv是由于四个水平推进器作用在水下航行器上的控制力和力矩，U为单个推进器推力；T是推进系统的推力器配置矩阵。
由于洋流在流体流动和水下航行器之间产生相对速度，因此需要考虑对水下航行器的水动力效应。根据高斯-马尔可夫(Gauss-Markov)定理，洋流速度可建模为以下形式：
Figure BDA0003047051080000094
其中，μc>0是合适的常数，ωc是高斯白噪声。为了限制模拟中的洋流速度，将有界洋流设置为：
Vmin≤Vc(t)≤Vmax (11)
可以假设流体是无旋转的，EF坐标中的洋流速度矢量如下：
Figure BDA0003047051080000101
式中，
Figure BDA0003047051080000102
北向和东向的洋流分量定义为：
vx＝Vc cosψc、vy＝Vc sinψc (13)
式中，ψc为水平洋流角。
通过旋转变换，可以得到EF坐标洋流速度与BF坐标洋流速度之间的关系：
Figure BDA0003047051080000103
其中，
Figure BDA0003047051080000104
和
Figure BDA0003047051080000105
分别表示涌浪和摇摆运动中的洋流速度。因此，水下航行器的相对速度(包括洋流的影响)由下式给出：
Figure BDA0003047051080000106
考虑洋流影响的水下航行器动力模型，三个自由度水下航行器的相对速度(包括洋流的影响)可改写为：
Figure BDA0003047051080000107
水下航行器的动态模型，包括用BF坐标表示的洋流，其形式如下：
Figure BDA0003047051080000108
假设洋流速度是缓慢变化的，这意味着
Figure BDA0003047051080000109
因此，动力学模型可以简化为：
Figure BDA00030470510800001010
因此，水下航行器的运动学和动力学模型(包括洋流)为：
Figure BDA00030470510800001011
如图4所示，为了系统地处理水下航行器的控制性能和功率方面的挑战，整个控制系统由两个级联模块组成，如滑模控制器和控制分配模块。滑模控制器模块负责根据每个自由度的当前状态和期望状态生成广义力和力矩，这些是实现水下航行器的期望位置和航向角所必需的。之后，控制分配模块有助于将这些广义力和力矩分配给推进系统的各个推进器，从而使整个系统消耗的功率最小。
滑模鲁棒控制器设计包括以下步骤：
为了简化控制器设计的复杂性，需要定义水下航行器在EF坐标下的动力学模型方程。为此，使用以下运动学变换：
Figure BDA00030470510800001012
两边求导，得
Figure BDA0003047051080000111
将等式(20)，(21)代入式(19)，可表示EF坐标系下水下航行器的动态模型：
Figure BDA0003047051080000112
其中，变换后的系统矩阵ME、CE、DE、GE和τE如下：
Figure BDA0003047051080000113
作为利用拉格朗日力学建立的动力系统，等式(22)中表示的水下航行器动力学方程具有以下假设：
假设1：惯性矩阵
Figure BDA0003047051080000114
对称且正定，因此：xTMEx＞0且矩阵ME的所有特征值满足条件：0＜λmin(ME)≤||ME||≤λmax(ME)。
假设2：矩阵
Figure BDA0003047051080000115
是斜对称的，因此满足以下公式：
Figure BDA0003047051080000116
Figure BDA0003047051080000117
η∈R3,v∈R3。
假设3：矩阵DE是正定的：DE>0，
Figure BDA0003047051080000118
假设4：假设水下航行器模型中不确定性矩阵ME、CE、DE、GE和外部扰动Fdis由一些已知函数限定，如下所示：
Figure BDA0003047051080000119
Figure BDA00030470510800001113
Figure BDA00030470510800001110
Figure BDA00030470510800001111
Figure BDA00030470510800001112
其中，∧和～分别表示估计系统矩阵和估计误差矩阵。
假设5：正有界对角矩阵满足下列不等式。
0≤λmin(Kr)||s||≤sTKrsign(s)；Kr＞0
其中，λmin表示对应矩阵的最小特征值，sign(s)为符号函数
设ηd＝[xd yd ψd]为水下航行器期望位置的向量。然后，跟踪误差定义为：
e(t)＝ηd-η (24)
关于时间的微分，公式(24)变成：
Figure BDA0003047051080000121
现在，引入滑模面函数为：
Figure BDA0003047051080000122
其中，∧>0是恒定控制增益，为正对角矩阵。
根据滑模控制器设计策略，水下航行器的控制律τ被构造为：
τ＝τeq+τsw (27)
式中，τeq是将系统状态合并到滑动面的等效项，τsw是补偿不确定性和干扰影响的开关项。等效控制τeq和开关控制τsw都可以得到：
Figure BDA0003047051080000123
τsw＝-βsign(s) (29)
其中，β是开关控制增益的正定矩阵，滑模面的符号函数用sign(s)表示。此符号函数可以表示为：
Figure BDA0003047051080000124
根据等式(28)和(29)，等式(27)中水下航行器的鲁棒滑模控制定律可重写如下：
Figure BDA0003047051080000125
为了避免使用等式(31)中的符号函数sign(s)产生抖振，可以构造饱和函数替换符号函数，如下所示：
Figure BDA0003047051080000126
其中，k根据实际情况选取。
其中，Ф是为了引进边界层而给出的边界，式(31)中的滑模控制定律为：
Figure BDA0003047051080000127
假设所有模型不确定性和干扰满足假设4，开关控制增益β根据式(34)选取。控制律τ由式(31)设计，则滑动面s渐近收敛到零，可以得出所设计的控制系统是渐近稳定的结论。
Figure BDA0003047051080000128
采用基于拉格朗日乘子的线性二次型控制分配包括以下设计步骤：
控制分配模块负责将根据滑模控制定律计算的力和力矩传递到可用的推进器组上，从而使功率消耗最小化。对于控制分配，采用拉格朗日乘子法。
等效控制输入τ和实际推力器动作U之间的关系可以假设为线性模型，其形式如下：
τ＝TU (35)
其中，矩阵T不是方阵，并且具有全行秩和/或非平凡子空间。因此，存在满足等式(35)的无限多个控制向量U。
为了补偿推力器的冗余，采用了摩尔-彭若斯广义逆方法。首先，最小二乘成本函数可以定义为：
U*＝argmin(UTWU) (36)
其中，W是加权推进器成本的正定矩阵。式(36)表示控制分配模块将寻求实现期望广义力τ的解，同时最小化目标函数UTWU表示的控制力。argmin(UTWU)是指使得函数UTWU取得其最小值的所有自变量U的集合。
接下来，二次能量函数被认为是：
Figure BDA0003047051080000131
可根据以下条件进行最小化
τ-TU＝0 (38)
因此，选择拉格朗日函数，表示为：
Figure BDA0003047051080000132
其中，λ表示拉格朗日乘数。方程(39)对U进行微分，得到以下方程：
Figure BDA0003047051080000133
根据等式(38)，等式(40)可以重写为：
τ＝TW-1TTλ (41)
最后，拉格朗日乘法的最优解可以得到如下：
λ＝(TW-1TT)-1τ (42)
将式(42)代入式(41)，矩阵T的广义逆
Figure BDA0003047051080000134
可产生如下：
Figure BDA0003047051080000135
因此，利用式(43)，实际推力器动作U可计算为：
Figure BDA0003047051080000136
以上仅是本发明的优选实施方式，本发明的保护范围并不仅局限于上述实施例，凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出，对于本技术领域的普通技术人员来说，在不脱离本发明原理前提下的若干改进和润饰，应视为本发明的保护范围。

Claims (6)

1.一种水下航行器无线充电系统，其特征在于，包括海上发电平台、潜于海面以下的水下航行器和海平面以上的无线充电接收器；
所述航行器包括接收器运动控制模块、动态定位模块、控制模块、整流滤波电路和系统电源；
所述无线充电接收器与海上发电平台的发射端通过强磁耦合，产生变化电流传输至整流滤波电路，对系统电源进行充电；
所述接收器运动控制模块，用于调整无线充电接收器的位置和角度；
所述动态定位模块，用于保持航行器在水中的位置及方向；
所述控制模块，用于根据无线充电接收器和航行器反馈的状态信号控制各模块的运行，以保持接收线圈与发射线圈间的相对位置。
2.根据权利要求1所述的一种水下航行器无线充电系统，其特征在于，所述接收器运动控制模块采用由舵机驱动的追踪机械臂，将无线充电接收器提升至海平面以上并实时调整无线充电接收器的状态。
3.根据权利要求2所述的一种水下航行器无线充电系统，其特征在于，所述动态定位模块包括坐标定位模块、动力驱动模块与动态定位控制模块，动力驱动模块由四个水平推进器构成，动态定位控制模块分为运动控制器模块和动力分配模块；
坐标定位模块反馈海上发电平台与水下航行器的相对位置；
根据海上发电平台与水下航行器的相对位置，运动控制模块计算水下航行器控制律；
动力分配模块根据水下航行器控制律进行动力驱动模块的推进器的力和力矩分配，使航行器接近海上发电平台，达到功率消耗最小化；
根据海上发电平台与水下航行器的相对位置，接收器运动控制模块通过追踪机械臂对接收线圈状态进行微调，达到最优的传输效率。
4.根据权利要求1-3任一项所述的一种水下航行器无线充电系统的控制方法，其特征在于，包括：
控制模块控制动态定位模块获取海上发电平台与水下航行器的相对位置，
根据海上发电平台与水下航行器的相对位置，动态定位模块的运动控制模块计算水下航行器控制律；
动态定位模块的动力分配模块根据水下航行器控制律进行动力驱动模块的推进器的力和力矩分配，使航行器接近海上发电平台，达到功率消耗最小化；
接收器运动控制模块根据海上发电平台与水下航行器的相对位置调整无线充电接收器的位置和角度，达到最优的传输效率；
无线充电接收器与海上发电平台的发射端通过强磁耦合，产生变化电流传输至整流滤波电路，对系统电源进行充电。
5.根据权利要求4所述的一种水下航行器无线充电系统的控制方法，其特征在于，所述运动控制模块采用滑模控制计算水下航行器控制律，其设计过程具体为：
步骤1、构建水下航行器在地球固定坐标系EF下的动力学模型方程：
Figure FDA0003047051070000021
其中，向量η＝[x y ψ]T表示水下航行器在EF坐标系中的线性位置x、y和欧拉角ψ，
Figure FDA0003047051070000027
为η的一阶微分，
Figure FDA0003047051070000023
为η的二阶微分，系统矩阵ME、CE、DE、GE和τE如下：
Figure FDA0003047051070000024
其中，旋转矩阵J(ψ)是航向角函数，J-1(ψ)表示J(ψ)的逆矩阵，J-T(ψ)表示J(ψ)的转置逆矩阵，M为惯性矩阵、C(vr)表示向心力和科里奥利矩阵、D(vr)表示阻尼矩阵、G(η)表示重力，τ表示控制输入，vr表示洋流影响下水下航行器的相对速度；
步骤2、设ηd＝[xd yd ψd]为水下航行器的期望位置，定义跟踪误差：
e(t)＝ηd-η (24)
关于时间的微分，等式(24)变成：
Figure FDA0003047051070000025
引入滑模面函数s为：
Figure FDA0003047051070000026
其中，∧是恒定控制增益，为对角正矩阵；
步骤3、根据滑模控制器设计策略，构造水下航行器的控制律τ：
τ＝τeq+τsw (27)
式中，τeq是将系统状态合并到滑动面的等效项，τsw是补偿不确定性和干扰影响的开关项；
等效控制τeq和开关控制τsw为：
Figure FDA0003047051070000031
τsw＝-βSgn(s) (29)
其中，
Figure FDA0003047051070000032
表示系统矩阵X的估计矩阵，X代表矩阵ME、CE、DE、GE,Fdis表示外部扰动，β是增益的正定矩阵，滑动面的符号函数用Sgn(s)表示：
Figure FDA0003047051070000033
步骤4、根据等式(28)和(29)，式(27)中水下航行器的鲁棒滑模控制定律重写如下：
Figure FDA0003047051070000034
用饱和函数sat替换符号函数，如下所示：
Figure FDA0003047051070000035
其中，Ф是为了引进边界层而给出的边界，式(31)中的滑模控制定律为：
Figure FDA0003047051070000036
6.根据权利要求4所述的一种水下航行器无线充电系统的控制方法，其特征在于，所述动力分配模块采用基于拉格朗日乘子的线性二次型控制分配方法进行动力分配，其设计过程包括以下步骤：
步骤一、等效控制输入τ和实际推力器动作U之间的关系T假设为线性模型，其形式如下：
τ＝TU (35)
其中，矩阵T不是方阵，并且具有全行秩和/或非平凡零空间，则存在满足等式(35)的无限多个控制向量U；
步骤二、采用了摩尔-彭若斯广义逆方法，首先，定义最小二乘成本函数：
U*＝argmin(UTWU) (36)
其中，W是加权推进器成本的正定矩阵；式(36)表示动力分配将寻求实现期望广义力τ的解，同时最小化目标函数UTWU表示的控制力；argmin(UTWU)是指使得函数UTWU取得其最小值的所有自变量U的集合；
进而二次能量函数为：
Figure FDA0003047051070000041
根据以下条件最小化：
τ-TU＝0 (38)
则选择拉格朗日函数表示为：
Figure FDA0003047051070000042
其中，λ表示拉格朗日乘数；
步骤三、方程(39)对U进行微分，得到以下方程：
Figure FDA0003047051070000043
步骤四、根据公式(38)，公式(40)重写为：
τ＝TW-1TTλ (41)
得到拉格朗日乘法的最优解如下：
λ＝(TW-1TT)-1τ (42)
将式(42)代入式(41)，广义逆
Figure FDA0003047051070000044
产生如下：
Figure FDA0003047051070000045
因此，利用式(43)，实际推力器动作U计算为：
Figure FDA0003047051070000046
CN202110475814.0A 2021-04-29 一种水下航行器无线充电系统及控制方法 Active CN113147438B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110475814.0A CN113147438B (zh) 2021-04-29 一种水下航行器无线充电系统及控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110475814.0A CN113147438B (zh) 2021-04-29 一种水下航行器无线充电系统及控制方法

Publications (2)

Publication Number Publication Date
CN113147438A true CN113147438A (zh) 2021-07-23
CN113147438B CN113147438B (zh) 2024-06-25

Family

ID=

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113467253A (zh) * 2021-08-11 2021-10-01 浙江大学 一种基于滑模控制和控制分配的无人艇航迹跟踪控制方法
CN114172243A (zh) * 2021-12-14 2022-03-11 南京工程学院 基于gpi控制器的水下航行器无线充电系统及控制方法

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113467253A (zh) * 2021-08-11 2021-10-01 浙江大学 一种基于滑模控制和控制分配的无人艇航迹跟踪控制方法
CN113467253B (zh) * 2021-08-11 2024-02-02 浙江大学 一种基于滑模控制和控制分配的无人艇航迹跟踪控制方法
CN114172243A (zh) * 2021-12-14 2022-03-11 南京工程学院 基于gpi控制器的水下航行器无线充电系统及控制方法
CN114172243B (zh) * 2021-12-14 2024-04-19 南京工程学院 基于gpi控制器的水下航行器无线充电系统及控制方法

Similar Documents

Publication Publication Date Title
CN108803632B (zh) 基于饱和补偿技术的水面无人艇全状态约束轨迹跟踪控制方法
CN107168312B (zh) 一种补偿uuv运动学和动力学干扰的空间轨迹跟踪控制方法
Sverdrup-Thygeson et al. The underwater swimming manipulator—A bioinspired solution for subsea operations
Ihle et al. Formation control of marine surface craft: A Lagrangian approach
CN112527018B (zh) 一种欠驱动自主水下航行器的三维镇定控制方法
Kadiyam et al. Conceptual design of a hybrid propulsion underwater robotic vehicle with different propulsion systems for ocean observations
CN112965371B (zh) 基于固定时间观测器的水面无人艇轨迹快速跟踪控制方法
CN111650948A (zh) 一种可底栖式auv的水平面轨迹快速跟踪控制方法
CN112148022A (zh) 全驱动自主水下机器人回收三维路径跟踪控制系统及方法
CN114115262B (zh) 基于方位角信息的多auv执行器饱和协同编队控制系统和方法
CN111857165B (zh) 一种水下航行器的轨迹跟踪控制方法
Zhang et al. Reaction-wheel-based roll stabilization for a robotic fish using neural network sliding mode control
Wang et al. Path following control of the wave glider in waves and currents
Jia et al. Distributed dynamic rendezvous control of the AUV-USV joint system with practical disturbance compensations using model predictive control
Zhang et al. Tracking fault-tolerant control based on model predictive control for human occupied vehicle in three-dimensional underwater workspace
CN113741433B (zh) 一种水面无人船的分布式编队方法
CN112925332A (zh) 无人艇与水下无人潜器联合系统的协同交会对接控制方法
Li et al. Dynamics modeling and experiments of wave driven robot
CN113147438B (zh) 一种水下航行器无线充电系统及控制方法
CN113147438A (zh) 一种水下航行器无线充电系统及控制方法
CN116027796A (zh) 一种多自治水下机器人编队控制系统及方法
Liu et al. Line-of-sight based three-dimensional path following control for an underactuated robotic dolphin
CN112947448B (zh) 一种无人船集群协同包围多目标模糊控制器结构及设计方法
CN114564015A (zh) 一种拒止环境下的欠驱动无人艇分布式编队控制方法
CN109062232B (zh) 海底地震检波飞行节点分布式有限时间防抖振构型包含控制方法

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