CN114802616A - 小型水面清污无人艇及其控制方法、定位方法 - Google Patents
小型水面清污无人艇及其控制方法、定位方法 Download PDFInfo
- Publication number
- CN114802616A CN114802616A CN202210396815.0A CN202210396815A CN114802616A CN 114802616 A CN114802616 A CN 114802616A CN 202210396815 A CN202210396815 A CN 202210396815A CN 114802616 A CN114802616 A CN 114802616A
- Authority
- CN
- China
- Prior art keywords
- uwb positioning
- ship
- control
- unmanned
- water
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000004140 cleaning Methods 0.000 title claims abstract description 28
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims abstract description 60
- 239000010813 municipal solid waste Substances 0.000 claims abstract description 48
- 230000033001 locomotion Effects 0.000 claims abstract description 28
- 241000195493 Cryptophyta Species 0.000 claims abstract description 19
- 239000007787 solid Substances 0.000 claims abstract description 10
- 239000002699 waste material Substances 0.000 claims abstract description 9
- 239000011159 matrix material Substances 0.000 claims description 19
- 238000005070 sampling Methods 0.000 claims description 12
- 238000000926 separation method Methods 0.000 claims description 8
- 230000005540 biological transmission Effects 0.000 claims description 7
- 238000007476 Maximum Likelihood Methods 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 6
- 239000012528 membrane Substances 0.000 claims description 6
- 238000001471 micro-filtration Methods 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 5
- 238000012545 processing Methods 0.000 claims description 4
- 239000012530 fluid Substances 0.000 claims description 3
- 239000002910 solid waste Substances 0.000 claims 1
- 238000005202 decontamination Methods 0.000 abstract description 7
- 230000003588 decontaminative effect Effects 0.000 abstract description 7
- 239000003344 environmental pollutant Substances 0.000 description 6
- 231100000719 pollutant Toxicity 0.000 description 6
- 238000012544 monitoring process Methods 0.000 description 5
- 238000013461 design Methods 0.000 description 4
- 238000004891 communication Methods 0.000 description 3
- 238000007667 floating Methods 0.000 description 3
- OKTJSMMVPCPJKN-UHFFFAOYSA-N Carbon Chemical compound [C] OKTJSMMVPCPJKN-UHFFFAOYSA-N 0.000 description 2
- 238000010521 absorption reaction Methods 0.000 description 2
- 108010066057 cabin-1 Proteins 0.000 description 2
- 108010066114 cabin-2 Proteins 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000005374 membrane filtration Methods 0.000 description 2
- 239000010865 sewage Substances 0.000 description 2
- 239000000126 substance Substances 0.000 description 2
- 241000196324 Embryophyta Species 0.000 description 1
- 102000004190 Enzymes Human genes 0.000 description 1
- 108090000790 Enzymes Proteins 0.000 description 1
- WHXSMMKQMYFTQS-UHFFFAOYSA-N Lithium Chemical compound [Li] WHXSMMKQMYFTQS-UHFFFAOYSA-N 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 230000002776 aggregation Effects 0.000 description 1
- 238000004220 aggregation Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000011942 biocatalyst Substances 0.000 description 1
- -1 biological ceramsite Substances 0.000 description 1
- 230000000903 blocking effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000008676 import Effects 0.000 description 1
- 229910052744 lithium Inorganic materials 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012067 mathematical method Methods 0.000 description 1
- 238000001208 nuclear magnetic resonance pulse sequence Methods 0.000 description 1
- 239000012466 permeate Substances 0.000 description 1
- 238000000746 purification Methods 0.000 description 1
- 238000012887 quadratic function Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63B—SHIPS OR OTHER WATERBORNE VESSELS; EQUIPMENT FOR SHIPPING
- B63B35/00—Vessels or similar floating structures specially adapted for specific purposes and not otherwise provided for
- B63B35/32—Vessels or similar floating structures specially adapted for specific purposes and not otherwise provided for for collecting pollution from open water
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/22—Measuring arrangements characterised by the use of optical techniques for measuring depth
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/0278—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves involving statistical or probabilistic considerations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/06—Position of source determined by co-ordinating a plurality of position lines defined by path-difference measurements
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
-
- 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
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A20/00—Water conservation; Efficient water supply; Efficient water use
- Y02A20/20—Controlling water pollution; Waste water treatment
- Y02A20/204—Keeping clear the surface of open water from oil spills
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Health & Medical Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Probability & Statistics with Applications (AREA)
- Environmental & Geological Engineering (AREA)
- Public Health (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Mechanical Engineering (AREA)
- Ocean & Marine Engineering (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明属于水域环境保护技术领域，具体涉及小型水面清污无人艇及其控制方法、定位方法。小型水面清污无人艇包括：用于垃圾收集的垃圾收集舱；所述垃圾收集舱包括固体垃圾收集舱和藻类垃圾处理舱；用于感知自身位置的感知装置；所述感知装置包括深度摄像头、激光雷达和UWB定位标签；用于控制船体运动的控制装置；所述控制装置包括运动控制器和主控制器；用于提供动力的推进装置；所述推进装置包括位于船尾的若干个水下推进器，用于负责船体前进转向的动力。本发明具有能够适用于中小型水池，并且能高效地清理水上浮游生物的特点。
Description
技术领域
本发明属于水域环境保护技术领域，具体涉及小型水面清污无人艇及其控制方法、定位方法。
背景技术
目前，水上垃圾不能自然稀释降解，只能以拦截打捞的方式清理。而利用无人艇清理水上垃圾比人工打捞更高效便捷，有助于解放劳动力。目前各公司生产了多款专用的水上清污无人船，不过这些无人船多用于大型的湖泊，很少考虑中小型水池的清理。此外，这些无人船多具有收集垃圾，清理水草等功能但很少考虑到水中浮游生物(如藻类)的清理。
因此，设计一种能够适用于中小型水池，并且能高效地清理水上浮游生物的小型水面清污无人艇及其控制方法、定位方法，就显得十分必要。
例如，申请号为CN202010247698.2的中国专利文献描述的一种水域清污装置、***及方法，包括岸基监测***、多艘无人艇和打捞网，岸基监测***用于接收无人艇传输的图像信息和位置信息，通过图像融合技术和目标识别技术辨识出无人艇前方水面的污染区域信息，并控制无人艇对污染区域进行清污；无人艇包括船体以及设置在船体上的控制模块、通信模块、动力模块、定位模块和监测模块。虽然通过多艘无人艇协同清污，能够提高清污效率；通过打捞网的特殊结构设计，能够实现水面垃圾的全方位清理，避免造成垃圾的遗漏；过岸基监测***根据无人艇发送的图像信息发出航向指令，提高了清污***的自动化程度，无需人为操作，节约了人力物力，但是其缺点在于，需要多艘无人艇实现水面垃圾的全方位清理，成本过高，且整体***并不适用于中小型水池。
发明内容
本发明是为了克服现有技术中，现有水上清污无人船不适用于中小型水池，且无法高效地清理水上浮游生物的问题，提供了一种能够适用于中小型水池，并且能高效地清理水上浮游生物的小型水面清污无人艇及其控制方法、定位方法。
为了达到上述发明目的，本发明采用以下技术方案：
小型水面清污无人艇，包括：
用于垃圾收集的垃圾收集舱；所述垃圾收集舱位于船体中心；所述垃圾收集舱包括固体垃圾收集舱和藻类垃圾处理舱；
用于感知自身位置的感知装置；所述感知装置位于船头上层；所述感知装置包括深度摄像头、激光雷达和UWB定位标签；
用于控制船体运动的控制装置；所述控制装置位于船头下层；所述控制装置包括运动控制器和主控制器；所述运动控制器用于检测航线、航速、船身倾角，并驱动电机；所述主控制器用于连接深度摄像头、激光雷达和UWB定位标签，并用于处理信息和传输信息；
用于提供动力的推进装置；所述推进装置包括位于船尾的若干个水下推进器，用于负责船体前进转向的动力。
作为优选，小型水面清污无人艇还包括UWB定位***；所述UWB定位***包括微控制模块和上位机定位模块；所述微控制模块包括至少四个基站；每个基站的位置固定，且每个基站之间的距离不超过200米；所述上位机定位模块用于设置巡航轨迹。
作为优选，所述基站和UWB定位标签均包括天线、与天线电连接的电路板、设于电路板上的微控制器、UWB定位模块和时钟模块。
作为优选，还包括活动式舱门；所述活动式舱门位于垃圾收集舱前侧。
作为优选，所述固体垃圾收集舱和藻类垃圾处理舱之间设有隔网；所述藻类垃圾处理舱的出水处设有微滤膜。
本发明还提供了小型水面清污无人艇的控制方法，所述运动控制器采用LQR控制器；还包括如下步骤：
全驱动控制：
S1，当无人艇航行于限制水域中，LQR控制器产生一个稳定的舵角来抵消岸吸力与岸吸力矩；
S2，设定***状态方程为
其中，x为***的状态向量；u为控制向量；D为***的干扰矩阵；A为由***运动方程推导而得的控制对象矩阵；B为控制矩阵；
设定代价函数
其中，x为***的状态向量，u为控制向量，Q为状态权重矩阵，R为控制权重矩阵；
将u＝-Kx代入代价函数，得到
设定存在常量矩阵P使得
为使J最小，由最小值原理得到最优控制为：K＝R-1BTP；
在***状态方程中加入一个状态变量y，使y等于瞬时航向偏移角，用于消除稳态横向漂移误差；
S3，根据岸吸力的公式，查阅公式中参数的数据库，得到岸吸力的大小；所述岸吸力的公式为：
其中，L为船的长度，B为船的宽度,T为吃水量，ρ为流体密度，V为航速,F为船体受到的水动力，M为船体受到的水动力矩，CF为横向力，CM为首摇力矩；
S4，根据岸吸力大小估计状态变量y(t)，再根据imu传感器感知船体航向并反馈调整状态变量的数值，使状态变量对时间的积分为漂移误差，
误差
t0为开始时间，t1为当前时间；
S5，无人艇通过状态变量不断调整航向，使无人艇回到既定航线；
欠驱动控制：
S6，按照全驱动控制中所述的状态变量定义渐近稳定的平面S，并定义形式上的控制律u；
S7，所有起始于平面S的***轨线都持续保持在平面S上，而且在平面S上滑动，直到所有***轨线在平面S上汇于一点；若有未在平面S上起始的***轨线，则对控制律u进行修改，直到所有***轨线在有限时间里，在平面S上汇于一点。
本发明还提供了小型水面清污无人艇的定位方法，包括如下步骤：
S101，UWB定位标签在测距前，先与各个基站进行一次通信，预先告知将在t0时刻发出测距脉冲信号；
S102，基站通信接收到时间信息，开始等待，并在t0时刻准备接收测距脉冲信号的时间序列，并通过计算估计测距脉冲信号的采样时延；
S103，基站在捕获到测距脉冲信号后，在粗估计无人艇位置的基础上，以采样点时间为间隔进行多次计算，得到采样点时间偏移量，最后再根据采样时延估计计算测距脉冲信号最先到达时刻的t1；
S104，根据t1-t0得出测距脉冲信号的传输时间，将得到的传输时间乘以电磁波传播速度得出基站和UWB定位标签之间的距离。
作为优选，所述UWB定位标签为3个；3个UWB定位标签分别放置在无人艇的船头、左后方和右后方；还包括如下步骤：
S105，根据3个UWB定位标签的相对位置以及运动控制器内置的imu传感器，得出无人艇的航向；
S106，当根据UWB定位标签相对位置得出的航向与imu传感器测得的航向不符时，通过imu传感器测得的航向，利用极大似然估计反推3个UWB定位标签位置的概率密度，得出各个UWB定位标签的最大概率位置，并进行UWB定位标签位置的矫正；
S107，通过3个UWB定位标签确定无人艇所在的具体范围，将信息传输给主控制器和上位机定位模块。
本发明与现有技术相比，有益效果是：(1)本发明适用于中小型水池，能够增加清理水面微小浮游生物(如藻类)的功能；(2)本发明带有高精度UWB定位***，能为控制器提供无人艇厘米级的精确位置，并通过上位机软件模块设置无人艇的巡航轨迹；(3)本发明中的轨迹跟踪采用全驱动加欠驱动的方法，无人艇利用带积分反馈的线性二次型最优控制算法完成全驱动控制，通过滑膜控制实现欠驱动控制，且无人艇在航行时，可以用污染物清理装置收集沿途的污染物。
附图说明
图1为本发明中小型水面清污无人艇的一种主视图；
图2为本发明中小型水面清污无人艇的一种左视图；
图3为本发明中小型水面清污无人艇的一种俯视图；
图4为本发明中基站以及UWB定位标签的一种结构示意图；
图5为本发明中小型水面清污无人艇的定位方法的一种定位示意图。
图中：固体垃圾收集舱1、藻类垃圾处理舱2、感知装置3、控制装置4、推进器5、水泵6、天线7、电路板8、微控制器9、UWB定位模块10、时钟模块11、活动式舱门12。
具体实施方式
为了更清楚地说明本发明实施例，下面将对照附图说明本发明的具体实施方式。显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图，并获得其他的实施方式。
实施例1：
如图1至图3所示的小型水面清污无人艇，包括：
用于垃圾收集的垃圾收集舱；所述垃圾收集舱位于船体中心；所述垃圾收集舱包括固体垃圾收集舱1和藻类垃圾处理舱2；
用于感知自身位置的感知装置3；所述感知装置位于船头上层；所述感知装置包括深度摄像头、激光雷达和UWB定位标签；
用于控制船体运动的控制装置4；所述控制装置位于船头下层；所述控制装置包括运动控制器和主控制器；所述运动控制器用于检测航线、航速、船身倾角，并驱动电机；所述主控制器用于连接深度摄像头、激光雷达和UWB定位标签，并用于处理信息和传输信息；
用于提供动力的推进装置；所述推进装置包括位于船尾的若干个水下推进器5，用于负责船体前进转向的动力。
小型水面清污无人艇内还设有用于抽水的水泵6，无人艇的供电部分采用6S锂电池，能同时提供水泵、推进装置和控制装置所需的电力。
进一步的，小型水面清污无人艇还包括UWB定位***；所述UWB定位***包括微控制模块和上位机定位模块；所述微控制模块包括四个基站；每个基站的位置固定，且每个基站之间的距离不超过200米；所述上位机定位模块用于设置巡航轨迹。
上位机定位模块实现的主要功能有：
1.与UWB定位标签通过蓝牙连接；
2.读取来自UWB定位标签的测距结果；
3.在平面图内设置各个基站的实际摆放位置；
4.显示UWB定位标签距离基站的距离，并计算UWB定位标签的位置(XYZ坐标)，在地图上实时显示；
5.地图显示，可以导入一张PNG格式的地图，能设置像素值与实际距离的比值以及坐标位置；
6.在地图上设置无人艇巡航轨迹。
进一步的，如图4所示，所述基站和UWB定位标签均包括天线7、与天线电连接的电路板8、设于电路板上的微控制器9、UWB定位模块10和时钟模块11。UWB定位标签由定位目标(无人艇)携带，与基站距离不超过两百米，通过与各个基站测距实现定位，每次测距结果汇总到主机站上再通过蓝牙模块传输给PC电脑。
进一步的，小型水面清污无人艇还包括活动式舱门12；所述活动式舱门位于垃圾收集舱前侧。
进一步的，所述固体垃圾收集舱和藻类垃圾处理舱之间设有隔网；所述藻类垃圾处理舱的出水处设有微滤膜。
基于实施例1，本发明还提供了小型水面清污无人艇的控制方法，所述运动控制器采用LQR控制器；还包括如下步骤：
全驱动控制：
S1，当无人艇航行于限制水域中，LQR控制器产生一个稳定的舵角来抵消岸吸力与岸吸力矩；
S2，设定***状态方程为
其中，x为***的状态向量；u为控制向量；D为***的干扰矩阵；A为由***运动方程推导而得的控制对象矩阵；B为控制矩阵；
设定代价函数
其中，x为***的状态向量，u为控制向量，Q为状态权重矩阵，R为控制权重矩阵；
将u＝-Kx代入代价函数，得到
设定存在常量矩阵P使得
为使J最小，由最小值原理得到最优控制为：K＝R-1BTP；
在***状态方程中加入一个状态变量y，使y等于瞬时航向偏移角，用于消除稳态横向漂移误差；
S3，根据岸吸力的公式，查阅公式中参数的数据库，得到岸吸力的大小；所述岸吸力的公式为：
其中，L为船的长度，B为船的宽度,T为吃水量，ρ为流体密度，V为航速,F为船体受到的水动力，M为船体受到的水动力矩，CF为横向力，CM为首摇力矩；
S4，根据岸吸力大小估计状态变量y(t)，再根据imu传感器感知船体航向并反馈调整状态变量的数值，使状态变量对时间的积分为漂移误差，
误差
t0为开始时间，t1为当前时间；
S5，无人艇通过状态变量不断调整航向，使无人艇回到既定航线；
本发明的全驱动控制方法选用带积分反馈的线性二次型最优控制LQR方法。
LQR控制器通过摆舵与降速可以有效地矫正与控制船舶的运动轨迹，保持了船舶航线稳定性，并为降低船舶相互碰撞的风险提供了良好的控制策略。
LQR控制器控制对象是状态空间形式线性***，而目标函数为对象状态和控制输入的二次型函数，通过计算出使目标函数值最小的增益矩阵，从而得到满足最优控制规律的时域舵角变化，实现对船舶运动的最优控制。当船舶偏至水道一侧接近岸壁航行时，船体将受到吸向近岸一侧的横向力，称为岸吸力的作用，出现船体被吸向岸壁的岸吸现象。与此同时，船体受到岸推力矩的作用，使船首转向航道中央的现象，即岸推现象。当船舶航行于限制水域中，LQR控制器将产生一个稳定的舵角来抵消岸吸力与岸吸力矩。当无人艇达到稳定状态时，船体产生一定的横移量，再保持原定航向继续航行，但偏离了原来既定航迹上，保证了航向稳定，但没能保证航迹的稳定。为了消除这一稳态横向漂移误差，将在状态空间方程中加入一个状态变量。根据岸吸力的公式，查阅相关参数的数据库，得到岸吸力的大小。根据岸吸力大小设置状态变量，再根据控制器内置imu传感器感知船体航向反馈调整状态标量数值。无人艇通过状态变量不断调整航向使无人艇回到既定航线。
此外，将imu传感器感知的姿态和航速通过积分运算，算出航迹偏离既定航线的数值，判定无人艇是否回到既定航线以及反馈偏离既定航线的位置。
欠驱动控制：
S6，按照全驱动控制中所述的状态变量定义渐近稳定的平面S，并定义形式上的控制律u；
S7，所有起始于平面S的***轨线都持续保持在平面S上，而且在平面S上滑动，直到所有***轨线在平面S上汇于一点；若有未在平面S上起始的***轨线，则对控制律u进行修改，直到所有***轨线在有限时间里，在平面S上汇于一点。
为使无人艇的运动与时间序列有关，欠驱动控制方法选用滑模控制。
在滑模控制方法中，按照***的状态变量定义渐近稳定的平面S，并定义形式上的控制律u。所有起始于这个平面的***轨线都继续保持在这个平面上，而且在这个平面上滑动，直到它们滑动至交叉处的期望的目的地。若有未在这个平面起始的***轨线，控制律就需要进行修改，使轨线就在有限时间里在这个平面上汇于一点。滑模控制律的设计可以被分为两个部分：设计一个合适的滑动面，使***的动态局限于滑动流形，产生所期望的行为；设计连续的控制律，其迫使***轨迹到滑动面，并保持在其上。
本发明针对水面无人艇***设计了轨迹跟踪滑模控制律，用两个滑动的平面来计算两个推进器的推力。
第一个滑动平面是按照纵向运动的跟踪误差所定义的一个一阶平面。
第二个滑动平面是按照横侧向运动的跟踪误差所定义的一个二阶平面。
在***中，只有船舶的绝对位置和航向角是可以测得并进行反馈的。因此船舶的绝对速度只能用数学的方法进行估计，通过惯性参考系和随船坐标系之间的运动学关系计算出纵荡和横荡速度。
考虑幂定律形式的阻抗力模型，设计滑模控制用来跟踪一个连续可微的目标轨迹。这个轨迹使用一组两个常微分方程，按照在两个平面的全球定位变量x和y来定义。
第一个滑动平面是一个按照船舶纵向运动跟踪误差所定义的指数式稳定的一阶平面；
第二个滑动面是一个二阶的指数式稳定的平面，按照船舶的横侧向运动跟踪误差进行定义。
如图5所示，本发明还提供了小型水面清污无人艇的定位方法，定位***由四个基站与无人艇所带标签组成。各个基站与标签兼起发送和接收信号的作用，通讯的范围在200米内。一号基站作为主基站，可通过蓝牙与上位机通讯。标签可分布在定位区域内的任意位置。
定位***前期准备如下：
1.首先，绘制无人艇工作场景地图，根据地图大小选择基站数量(图5中为4个)，并选择基站放置位置。确保工作场景内的任意位置都被所有的基站覆盖，覆盖的基站越多定位的精度越高。
2.将绘制好的地图上传到上位机软件模块中，设置好地图实际尺寸与像素值的比值，并根据具***置和南北朝向标记各基站的坐标值。
3.在工作区域内将基站按照地图设置摆放，并在定位范围内放置无人艇。
定位方案流程如下：
基站和标签通过脉冲无线电实现UWB通讯，利用单脉冲信号组成的时域脉冲序列发射信号。为提高信号的传输能力和分辨能力，通过多模谐振滤波器实现信号的宽阻带。
定位方法采用TOA方法，具体包括如下步骤：
S101，UWB定位标签在测距前，先与各个基站进行一次通信，预先告知将在t0时刻发出测距脉冲信号；
S102，基站通信接收到时间信息，开始等待，并在t0时刻准备接收测距脉冲信号的时间序列，并通过计算估计测距脉冲信号的采样时延；
S103，基站在捕获到测距脉冲信号后，在粗估计无人艇位置的基础上，以采样点时间为间隔进行多次计算，得到采样点时间偏移量，最后再根据采样时延估计计算测距脉冲信号最先到达时刻的t1；
S104，根据t1-t0得出测距脉冲信号的传输时间，将得到的传输时间乘以电磁波传播速度得出基站和UWB定位标签之间的距离。
测得距离后，采用极大似然估计法计算标签位置。通常标签坐标为以各基站坐标为圆心，以基站到标签的距离为半径的各个圆的交点处。而在实际测量中，由于距离的测量误差，标签位置可能并不在以各基站位置为圆心的圆的交点上。因此用极大似然估计法，通过对测距结构误差余量做统计拟合得出其近似正态分布，再由极大似然估计原理得出标签的位置。得出估计结果，经过卡尔曼滤波器后将信息传输到无人艇控制器和上位机。
进一步的，所述UWB定位标签为3个；3个UWB定位标签分别放置在无人艇的船头、左后方和右后方；还包括如下步骤：
S105，根据3个UWB定位标签的相对位置以及运动控制器内置的imu传感器，得出无人艇的航向；
S106，当根据UWB定位标签相对位置得出的航向与imu传感器测得的航向不符时，通过imu传感器测得的航向，利用极大似然估计反推3个UWB定位标签位置的概率密度，得出各个UWB定位标签的最大概率位置，并进行UWB定位标签位置的矫正；
S107，通过3个UWB定位标签确定无人艇所在的具体范围，将信息传输给主控制器和上位机定位模块。
无人艇携带3个标签，用于避免测距误差影响定位精度。
本发明的垃圾收集方法，具体如下：
无人艇的前侧有活动式舱门，在工作时，两扇舱门打开呈135度角张开，将更多的垃圾导入垃圾收集舱内。无人艇前进时，路径上漂浮在水面的垃圾被收入船舱内。此外船尾的水泵抽水，抽入的水带动更多的垃圾进入船舱。
船舱内的垃圾收集舱由隔网分成两部分，前端为固体垃圾收集处，后端为藻类污染物处理处。当水流带着漂浮的垃圾一同流入垃圾收集舱内后，由于隔网的阻拦，较大的固体垃圾会被阻挡在固体垃圾收集处，较小的垃圾如藻类通过隔网进入藻类污染物处理处。船尾出水处放有微滤膜，水流被水泵吸出舱外，而微小垃圾则通过膜滤法留在舱内。膜滤法以微小孔径级别的选择性透过膜为分离介质，以压力差和浓度差作为驱动，从而使水流中的物质选择性地透过膜，实现分离或提纯。除此之外，藻类垃圾清理处还放有活性炭、生物陶粒、生物催化剂IBC等能吸附和分解藻类的物质，减轻微滤网的压力避免大量微小垃圾集结而导致微滤网处被堵住。
本发明适用于中小型水池，能够增加清理水面微小浮游生物(如藻类)的功能；本发明带有高精度UWB定位***，能为控制器提供无人艇厘米级的精确位置，并通过上位机软件模块设置无人艇的巡航轨迹；本发明中的轨迹跟踪采用全驱动加欠驱动的方法，无人艇利用带积分反馈的线性二次型最优控制算法完成全驱动控制，通过滑膜控制实现欠驱动控制，且无人艇在航行时，可以用污染物清理装置收集沿途的污染物。
以上所述仅是对本发明的优选实施例及原理进行了详细说明，对本领域的普通技术人员而言，依据本发明提供的思想，在具体实施方式上会有改变之处，而这些改变也应视为本发明的保护范围。
Claims (8)
1.小型水面清污无人艇，其特征在于，包括：
用于垃圾收集的垃圾收集舱；所述垃圾收集舱位于船体中心；所述垃圾收集舱包括固体垃圾收集舱和藻类垃圾处理舱；
用于感知自身位置的感知装置；所述感知装置位于船头上层；所述感知装置包括深度摄像头、激光雷达和UWB定位标签；
用于控制船体运动的控制装置；所述控制装置位于船头下层；所述控制装置包括运动控制器和主控制器；所述运动控制器用于检测航线、航速、船身倾角，并驱动电机；所述主控制器用于连接深度摄像头、激光雷达和UWB定位标签，并用于处理信息和传输信息；
用于提供动力的推进装置；所述推进装置包括位于船尾的若干个水下推进器，用于负责船体前进转向的动力。
2.根据权利要求1所述的小型水面清污无人艇，其特征在于，还包括UWB定位***；所述UWB定位***包括微控制模块和上位机定位模块；所述微控制模块包括至少四个基站；每个基站的位置固定，且每个基站之间的距离不超过200米；所述上位机定位模块用于设置巡航轨迹。
3.根据权利要求2所述的小型水面清污无人艇，其特征在于，所述基站和UWB定位标签均包括天线、与天线电连接的电路板、设于电路板上的微控制器、UWB定位模块和时钟模块。
4.根据权利要求1所述的小型水面清污无人艇，其特征在于，还包括活动式舱门；所述活动式舱门位于垃圾收集舱前侧。
5.根据权利要求1-4任一项所述的小型水面清污无人艇，其特征在于，所述固体垃圾收集舱和藻类垃圾处理舱之间设有隔网；所述藻类垃圾处理舱的出水处设有微滤膜。
6.基于权利要求3所述的小型水面清污无人艇的控制方法，其特征在于，所述运动控制器采用LQR控制器；还包括如下步骤：
全驱动控制：
S1，当无人艇航行于限制水域中，LQR控制器产生一个稳定的舵角来抵消岸吸力与岸吸力矩；
S2，设定***状态方程为
其中，x为***的状态向量；u为控制向量；D为***的干扰矩阵；A为由***运动方程推导而得的控制对象矩阵；B为控制矩阵；
设定代价函数
其中，x为***的状态向量，u为控制向量，Q为状态权重矩阵，R为控制权重矩阵；
将u＝-Kx代入代价函数，得到
设定存在常量矩阵P使得
为使J最小，由最小值原理得到最优控制为：K＝R-1BTP；
在***状态方程中加入一个状态变量y，使y等于瞬时航向偏移角，用于消除稳态横向漂移误差；
S3，根据岸吸力的公式，查阅公式中参数的数据库，得到岸吸力的大小；所述岸吸力的公式为：
其中，L为船的长度，B为船的宽度,T为吃水量，ρ为流体密度，V为航速,F为船体受到的水动力，M为船体受到的水动力矩，CF为横向力，CM为首摇力矩；
S4，根据岸吸力大小估计状态变量y(t)，再根据imu传感器感知船体航向并反馈调整状态变量的数值，使状态变量对时间的积分为漂移误差，
误差
t0为开始时间，t1为当前时间；
S5，无人艇通过状态变量不断调整航向，使无人艇回到既定航线；
欠驱动控制：
S6，按照全驱动控制中所述的状态变量定义渐近稳定的平面S，并定义形式上的控制律u；
S7，所有起始于平面S的***轨线都持续保持在平面S上，而且在平面S上滑动，直到所有***轨线在平面S上汇于一点；若有未在平面S上起始的***轨线，则对控制律u进行修改，直到所有***轨线在有限时间里，在平面S上汇于一点。
7.基于权利要求3所述的小型水面清污无人艇的定位方法，其特征在于，包括如下步骤：
S101，UWB定位标签在测距前，先与各个基站进行一次通信，预先告知将在t0时刻发出测距脉冲信号；
S102，基站通信接收到时间信息，开始等待，并在t0时刻准备接收测距脉冲信号的时间序列，并通过计算估计测距脉冲信号的采样时延；
S103，基站在捕获到测距脉冲信号后，在粗估计无人艇位置的基础上，以采样点时间为间隔进行多次计算，得到采样点时间偏移量，最后再根据采样时延估计计算测距脉冲信号最先到达时刻的t1；
S104，根据t1-t0得出测距脉冲信号的传输时间，将得到的传输时间乘以电磁波传播速度得出基站和UWB定位标签之间的距离。
8.根据权利要求7所述的小型水面清污无人艇的定位方法，其特征在于，所述UWB定位标签为3个；3个UWB定位标签分别放置在无人艇的船头、左后方和右后方；还包括如下步骤：
S105，根据3个UWB定位标签的相对位置以及运动控制器内置的imu传感器，得出无人艇的航向；
S106，当根据UWB定位标签相对位置得出的航向与imu传感器测得的航向不符时，通过imu传感器测得的航向，利用极大似然估计反推3个UWB定位标签位置的概率密度，得出各个UWB定位标签的最大概率位置，并进行UWB定位标签位置的矫正；
S107，通过3个UWB定位标签确定无人艇所在的具体范围，将信息传输给主控制器和上位机定位模块。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210396815.0A CN114802616B (zh) | 2022-04-15 | 2022-04-15 | 小型水面清污无人艇及其控制方法、定位方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210396815.0A CN114802616B (zh) | 2022-04-15 | 2022-04-15 | 小型水面清污无人艇及其控制方法、定位方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN114802616A true CN114802616A (zh) | 2022-07-29 |
| CN114802616B CN114802616B (zh) | 2023-08-04 |
Family
ID=82537269
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202210396815.0A Active CN114802616B (zh) | 2022-04-15 | 2022-04-15 | 小型水面清污无人艇及其控制方法、定位方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114802616B (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN115792799A (zh) * | 2022-11-30 | 2023-03-14 | 上海船舶运输科学研究所有限公司 | 一种船模轨迹测绘方法及*** |
Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105180942A (zh) * | 2015-09-11 | 2015-12-23 | 安科智慧城市技术（中国）有限公司 | 一种无人船自主导航方法及装置 |
| CN105852817A (zh) * | 2015-01-20 | 2016-08-17 | 中国人民解放军第二军医大学 | 船员海上舱内定位、生命体征监测及搜救方法 |
| CN105898698A (zh) * | 2016-04-26 | 2016-08-24 | 上海交通大学 | 一种基于uwb的船舶靠泊辅助方法和*** |
| CN107719593A (zh) * | 2017-09-11 | 2018-02-23 | 上海电机学院 | 一种具备浮动式打捞运输结构的水面垃圾清扫船 |
| CN207972758U (zh) * | 2018-01-12 | 2018-10-16 | 中国科学院合肥物质科学研究院 | 一种混合动力水面清洁机器人 |
| CN110185013A (zh) * | 2019-05-09 | 2019-08-30 | 上海海事大学 | 基于机器视觉识别的水面清洁船装置及水面清洁方法 |
| CN111290395A (zh) * | 2020-03-10 | 2020-06-16 | 上海航天控制技术研究所 | 一种基于子母艇的无人艇自主回收方法 |
| US20200193840A1 (en) * | 2018-12-14 | 2020-06-18 | Brunswick Corporation | Marine Propulsion Control System and Method with Proximity-Based Velocity Limiting |
| CN111452924A (zh) * | 2020-03-19 | 2020-07-28 | 哈尔滨工业大学 | 一种水面垃圾清理机器人 |
| CN112693571A (zh) * | 2021-01-26 | 2021-04-23 | 中电建水环境科技有限公司 | 一种水面智能清漂船以及水面智能清漂方法 |
-
2022
- 2022-04-15 CN CN202210396815.0A patent/CN114802616B/zh active Active
Patent Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN105852817A (zh) * | 2015-01-20 | 2016-08-17 | 中国人民解放军第二军医大学 | 船员海上舱内定位、生命体征监测及搜救方法 |
| CN105180942A (zh) * | 2015-09-11 | 2015-12-23 | 安科智慧城市技术（中国）有限公司 | 一种无人船自主导航方法及装置 |
| CN105898698A (zh) * | 2016-04-26 | 2016-08-24 | 上海交通大学 | 一种基于uwb的船舶靠泊辅助方法和*** |
| CN107719593A (zh) * | 2017-09-11 | 2018-02-23 | 上海电机学院 | 一种具备浮动式打捞运输结构的水面垃圾清扫船 |
| CN207972758U (zh) * | 2018-01-12 | 2018-10-16 | 中国科学院合肥物质科学研究院 | 一种混合动力水面清洁机器人 |
| US20200193840A1 (en) * | 2018-12-14 | 2020-06-18 | Brunswick Corporation | Marine Propulsion Control System and Method with Proximity-Based Velocity Limiting |
| CN110185013A (zh) * | 2019-05-09 | 2019-08-30 | 上海海事大学 | 基于机器视觉识别的水面清洁船装置及水面清洁方法 |
| CN111290395A (zh) * | 2020-03-10 | 2020-06-16 | 上海航天控制技术研究所 | 一种基于子母艇的无人艇自主回收方法 |
| CN111452924A (zh) * | 2020-03-19 | 2020-07-28 | 哈尔滨工业大学 | 一种水面垃圾清理机器人 |
| CN112693571A (zh) * | 2021-01-26 | 2021-04-23 | 中电建水环境科技有限公司 | 一种水面智能清漂船以及水面智能清漂方法 |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN115792799A (zh) * | 2022-11-30 | 2023-03-14 | 上海船舶运输科学研究所有限公司 | 一种船模轨迹测绘方法及*** |
Also Published As
| Publication number | Publication date |
|---|---|
| CN114802616B (zh) | 2023-08-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US10589829B2 (en) | Gliding robotic fish navigation and propulsion | |
| CN100443369C (zh) | 深海太阳能潜水器 | |
| Caccia et al. | Basic navigation, guidance and control of an unmanned surface vehicle | |
| US8418642B2 (en) | Unmanned submersible vehicles and methods for operating the same in a body of liquid | |
| CN113433933B (zh) | 一种智能水面保洁无人船的自主巡航方法 | |
| Dunbabin et al. | An autonomous surface vehicle for water quality monitoring | |
| CN108312151B (zh) | 漂流探测水下机器人装置及控制方法 | |
| Ferri et al. | The HydroNet ASV, a small-sized autonomous catamaran for real-time monitoring of water quality: From design to missions at sea | |
| Wood et al. | Autonomous underwater gliders | |
| CN112960078A (zh) | 一种无人帆船自动驾驶***及其方法 | |
| Mousazadeh et al. | Experimental evaluation of a hydrography surface vehicle in four navigation modes | |
| CN114802616B (zh) | 小型水面清污无人艇及其控制方法、定位方法 | |
| KR101806393B1 (ko) | 무인 자율 운항이 가능한 이동식 수질정화장치 | |
| Francis et al. | Development of a highly portable unmanned surface vehicle for surf zone bathymetric surveying | |
| Al Maawali et al. | Design and implementation of an unmanned surface vehicle for oil spill handling | |
| EP3696078B1 (en) | A method and system for piloting an unmanned surface vessel | |
| EP3501966A1 (en) | An unmanned marine surface vessel | |
| Yaakob et al. | Development of unmanned surface vehicle (USV) for sea patrol and environmental monitoring | |
| CN110667790A (zh) | 一种空气动力水面除草清污装备和清污方法 | |
| Liu et al. | Unmanned airboat technology and applications in environment and agriculture | |
| CN109263814A (zh) | 一种新型水面多功能自主巡航船*** | |
| CN212082961U (zh) | 一种基于无人船的水质取样监测*** | |
| CN111332415A (zh) | 一种自主巡航节能水质监测船及监测方法 | |
| CN211978876U (zh) | 一种用于协同水环境中油污污染源监测和追踪的无人船 | |
| Sanfilippo et al. | The aquatic surface robot (AnSweR), a lightweight, low cost, multipurpose unmanned research vessel |
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 |