CN109250106A - 一种基于压强传感器切换多栖航行器工作模式的方法 - Google Patents
一种基于压强传感器切换多栖航行器工作模式的方法 Download PDFInfo
- Publication number
- CN109250106A CN109250106A CN201811174522.8A CN201811174522A CN109250106A CN 109250106 A CN109250106 A CN 109250106A CN 201811174522 A CN201811174522 A CN 201811174522A CN 109250106 A CN109250106 A CN 109250106A
- Authority
- CN
- China
- Prior art keywords
- aircraft
- pressure
- working environment
- operating mode
- moment
- 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
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64C—AEROPLANES; HELICOPTERS
- B64C35/00—Flying-boats; Seaplanes
- B64C35/008—Amphibious sea planes
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Mechanical Engineering (AREA)
- Testing Or Calibration Of Command Recording Devices (AREA)
- Force Measurement Appropriate To Specific Purposes (AREA)
Abstract
本发明披露了一种基于压强传感器判断多栖航行器工作环境的方法,可以解决由于人工操作延迟导致多栖航行器未能及时改变航行器工作模式致使航行器损坏问题。在航行器的上部和下部两侧放置两个压强传感器,基于航行器在两种环境介质密度的显著不同,根据测量航行器上下所受的压强差,判断航行器所处的环境。设置不同环境中航行器所受压强差的阈值范围,判断检测到的航行器所受压强差所在的阈值范围,确定航行器的工作环境是在空中、水面还是水下,并与上一时刻比较,判断航行器的工作环境是否发生变化,若发生变化,切换至对应的工作模式。本发明可以有效的保护多栖航行器,解决由于操作员未能及时改变航行器工作模式导致的航行器损坏问题。
Description
技术领域
本发明涉及判断航行器工作环境的方法,具体是一种可以通过压强传感器判断多栖航行器工作环境的方法。
背景技术
目前,多栖无人航行器可以实现在空中和水面、水面和水下两种环境下工作,以及控制、水面和水下三种环境下工作,而环境的变换一般需要相应的模式变化。现如今一般是操纵者判断是否需要切换模式,然后由操纵者通过遥控器控制航行器以实现切换模式的功能,航行器不具有自主判断自身所处环境的能力,例如:一种空水多栖航行器,闻祥鑫,申请号:CN201710656452.9,但是该多栖航行器是通过人工遥控控制航行器的状态切换,而人工操作有一定的延迟性,不如机器反应的灵敏,所以本发明提出了一种用于多栖航行器自主判断空中,水面,水下环境的方法,即判断航行器所处的环境。
发明内容
本发明的目的在于提供一种用于多栖航行器判断空中,水面,水下环境的方法。
在航行器的上部和下部两侧放置两个压强传感器,基于航行器在两种环境介质密度的显著不同,根据测量航行器上下所受的压强差,判断航行器所处的环境。设置不同环境中航行器所受压强差的阈值范围,判断检测到航行器所受压强差ΔP所在的阈值范围,确定航行器的工作环境,并于上一时刻比较,判断航行器的工作环境是否发生变化,若发生变化,切换至对应的工作模式。P为航行器在航行过程中表面受到的压强的大小,其中为动压,ρgh为航行器在水下的部分受到的压强,ρ为航行器所处的环境的密度,v为垂直于航行器表面的航行速度,h为航行器在水下部分的表面距离水面的高度,若航行器整体都不在水下则h=0。P0为航行器在空中上升或下降时所受的动压,该值也近似看作空中航行器上侧和下侧的压强差。P1为航行器在水下上升或下降时所受的动压和浮力之和,该值也近似看作水下航行器上侧和下侧的压强差。P2为航行器在水水面航行时所受的浮力,该值也近似看作水下航行器上侧和下侧的压强差。水面航行器所受压强差的阈值为P3。航行器开始工作时就开始计时,用t时刻表示航行器的工作时长为t时对应的时刻,其中t>0,t时刻为任意大于零的时刻,则t+1时刻表示该时刻的下一时刻。
P2=ρ2gh
步骤一、航行控制器读取两个压强传感器测量的压强值P,计算航行器上侧和下侧的压强差ΔP,判断t时刻航行器的工作环境:
步骤1.1、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值小于阈值P3内的最小值时,判断此时的工作环境为空中;
步骤1.2、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值在阈值P3内时,判断此时的工作环境为水面;
步骤1.3、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值大于阈值P3内的最小值时,判断此时的工作环境为水下;
步骤二、航行控制器读取两个压强传感器测量的压强值P,判断t+1时刻航行器的工作环境:
步骤2.1、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值小于阈值P3内的最小值时,判断此时的工作环境为空中;
步骤2.2、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值在阈值P3内时,判断此时的工作环境为水面;
步骤2.3、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值大于阈值P3内的最小值时,判断此时的工作环境为水下;
步骤三、比较t时刻和t+1时刻航行器的工作环境是否发生变化
工作模式1即飞行状态时,连杆与航行器主体1的角度为0度,连杆与航行器主体1平行,航行器主体1呈X型;工作模式2水面过渡状态时,连杆与航行器主体1的角度为0度,连杆与航行器主体1平行,航行器主体1呈一字型;工作模式3水下航行状态时,连杆与航行器主体1的角度一般为90度,也可根据时间情况调节,航行器主体1呈一字型:
步骤3.1、若两个时刻航行器的工作环境没有发生变化,则航行器的工作模式不需要发生变化;
步骤3.2、若t时刻航行器的工作环境为空中,而t+1时刻航行器的工作环境为水面,则航行器由空中下降到水面,切换航行器的工作模式,即由工作模式1切换为工作模式2;
步骤3.3、若t时刻航行器的工作环境为水面,而t+1时刻航行器的工作环境为水下,则航行器由水面下降到水下,切换航行器的工作模式,即由工作模式2切换为工作模式3;
步骤3.4、若t时刻航行器的工作环境为水下,而t+1时刻航行器的工作环境为水面,则航行器由水下上升到水面,切换航行器的工作模式,即由在工作模式3切换为工作模式2;
步骤3.5、若t时刻航行器的工作环境为水面,而t+1时刻航行器的工作环境为空中,则航行器由水面上升到空中,切换航行器的工作模式,即由在工作模式2切换为工作模式1。
附图说明
图1为总体流程图。
图2为判断是否需要切换工作模式的流程图。
图3为多栖航行器空中飞行状态的结构示意图。
图4为空水多栖航行器水面过渡状态的结构示意图。
图5为空水多栖航行器水面及水下航行状态的结构示意图。
具体实施方式
如图3至图5所示,一种空水多栖航行器,包括航行器主体1、控制模块、状态切换模块、净浮力调节模块、动力模块、通信导航模块和电源模块;所述航行器主体1的每个机翼尾部通过连杆连接有水仓室2,所述连杆的内部是中空的腔室,连杆的底部开有进水孔;所述航行器主体1的内部设置有控制模块、通信导航模块和电源模块,所述控制模块分别与状态切换模块、净浮力调节模块、动力模块、通信导航模块、电源模块相连接;所述航行器主体1的每个机翼尾部设置有状态切换模块,所述状态切换模块包括舵机3和传动装置;所述舵机3的控制端与控制模块相电性连接,舵机3的电源端与电源模块相电性连接,舵机3的输出端通过传动装置与相对应的连杆相传动连接;所述每个水仓室2内设置有净浮力调节模块和动力模块;所述净浮力调节模块包括气泵,所述气泵通过软管4将水仓室2与连杆内部相连通,气泵的控制端与控制模块相电性连接;所述动力模块包括电机5和螺旋桨6,所述电机5的输出端与螺旋桨6相传动连接,电机5的控制端与控制模块相电性连接,电机5的电源端与电源模块相电性连接;所述航行器主体1的中心轴处设置有主舵机7,主舵机7的输出端通过传动装置与中心轴相传动连接,主舵机7的控制端与控制模块相电性连接,主舵机7的电源端与电源模块相电性连接;所述航行器主体1的中心轴上方设置有天线8,天线8的顶端设置有GPS,天线8的底端与通信导航模块相连接;所述航行器主体1的中心轴下方设置有压强传感器和激光测距仪,压强传感器和激光测距仪均与控制模块相电性连接;所述航行器主体1的中心轴上方和下方设置有压强传感器,压强传感器与控制模块相电性连接;所述航行器主体1的内部设置有加速度计和陀螺仪,加速度计和陀螺仪与控制模块相电性连接;所述航行器主体1的外壳采用防水材料制成,控制模块、状态切换模块、净浮力调节模块、动力模块、通信导航模块和电源模块的外侧均设置有防水层,且各连接处采用防水密封圈加防水胶水处理,内部各模块使用也做相应的防水处理。
当航行器接近水面时,开启该功能。如图1所示,用航行控制器读取上部和下部两侧的压强传感器检测到的压强值,计算压强差值,判断航行器的工作环境,再与上一时刻的工作环境相比较,判断是否需要改变航行器的工作模式。为了加深对本发明的理解,下面结合实施例对本发明做进一步的详细描述。但是,本发明可以以不同的形式来实现,并不限于本文所描述的实例。根据文献,空气的密度约为1.29kg/m3,水的密度约为1.0×103kg/m3。实例将空气的密度定为1.29kg/m3,水的密度定为1.0×103kg/m3,重力加速度为9.8m/s2,航行器的高度为15cm。航行器由空中的航行环境改变为水面的航行环境时,当下降速度降低为1ms时,航行器两侧的压强差为0.645Pa,航行器在即将接触水面时的下降速度小于1ms,即航行器此时两侧的压强差可近似为0;航行器由空中的航行环境改变为水面的航行环境时,将航行器下降的速度近似看作为0,当航行器触及水面1cm时,航行器上侧和下侧的压强差值为98Pa;航行器由水下的航行环境改变为水面的航行环境时,上升速度会降低近似为0,未到水面时航行器上侧和下侧的压强差值为1470Pa;故将航行器在水面航行时的压强差的阈值P3设置为10Pa~1470Pa。具体如下:
步骤一、航行控制器读取两个压强传感器测量的压强值P,计算航行器上侧和下侧的压强差ΔP,判断t时刻航行器的工作环境:
步骤1.1、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值小于阈值P3内的最小值时,判断此时的工作环境为空中;
步骤1.2、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值在阈值P3内时,判断此时的工作环境为水面;
步骤1.3、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值大于阈值P3内的最小值时,判断此时的工作环境为水下;
步骤二、航行控制器读取两个压强传感器测量的压强值P,判断t+1时刻航行器的工作环境:
步骤2.1、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值小于阈值P3内的最小值时,判断此时的工作环境为空中;
步骤2.2、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值在阈值P3内时,判断此时的工作环境为水面;
步骤2.3、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值大于阈值P3内的最小值时,判断此时的工作环境为水下;
步骤三、比较t时刻和t+1时刻航行器的工作环境是否发生变化:
工作模式1即飞行状态时,连杆与航行器主体1的角度为0度,连杆与航行器主体1平行,航行器主体1呈X型;工作模式2水面过渡状态时,连杆与航行器主体1的角度为0度,连杆与航行器主体1平行,航行器主体1呈一字型;工作模式3水下航行状态时,连杆与航行器主体1的角度一般为90度,也可根据时间情况调节,航行器主体1呈一字型;
步骤3.1、如图2所示,若两个时刻航行器的工作环境没有发生变化,则航行器的工作模式不需要发生变化;
步骤3.2、若t时刻航行器的工作环境为空中,而t+1时刻航行器的工作环境为水面,则航行器由空中下降到水面,切换航行器的工作模式,即由工作模式1切换为工作模式2;
步骤3.3、若t时刻航行器的工作环境为水面,而t+1时刻航行器的工作环境为水下,则航行器由水面下降到水下,切换航行器的工作模式,即由工作模式2切换为工作模式3;
步骤3.4、若t时刻航行器的工作环境为水下,而t+1时刻航行器的工作环境为水面,则航行器由水下上升到水面,切换航行器的工作模式,即由在工作模式3切换为工作模式2;
步骤3.5、若t时刻航行器的工作环境为水面,而t+1时刻航行器的工作环境为空中,则航行器由水面上升到空中,切换航行器的工作模式,即由在工作模式2切换为工作模式1。
Claims (1)
1.一种基于压强传感器切换多栖航行器工作模式的方法,航行器在航行过程中表面受到的压强的大小P为:
其中为动压,ρgh为航行器在水下的部分受到的压强,ρ为航行器所处的环境的密度,v为垂直于航行器表面的航行速度,h为航行器在水下部分的表面距离水面的高度,若航行器整体都不在水下,则h=0;多栖航行器上侧和下侧所受压强的差值的阈值为P3;其特征在于所述基于压强传感器切换多栖航行器工作模式的方法包括以下步骤:
步骤一、航行控制器读取两个压强传感器测量的压强值P,计算航行器上侧和下侧的压强差ΔP,判断t时刻航行器的工作环境:
步骤1.1、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值小于阈值P3内的最小值时,判断此时的工作环境为空中;
步骤1.2、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值在阈值P3内时,判断此时的工作环境为水面;
步骤1.3、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值大于阈值P3内的最小值时,判断此时的工作环境为水下;
步骤二、航行控制器读取两个压强传感器测量的压强值P,判断t+1时刻航行器的工作环境:
步骤2.1、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值小于阈值P3内的最小值时,判断此时的工作环境为空中;
步骤2.2、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值在阈值P3内时,判断此时的工作环境为水面;
步骤2.3、当航行器上侧的压强传感器检测到的压强值Pu和航行器下侧的压强传感器检测到的压强值Pd的差值大于阈值P3内的最小值时,判断此时的工作环境为水下;
步骤三、比较t时刻和t+1时刻航行器的工作环境是否发生变化:
工作模式1即飞行状态时,连杆与航行器主体1的角度为0度,连杆与航行器主体1平行,航行器主体1呈X型;工作模式2水面过渡状态时,连杆与航行器主体1的角度为0度,连杆与航行器主体1平行,航行器主体1呈一字型;工作模式3水下航行状态时,连杆与航行器主体1的角度一般为90度,也可根据时间情况调节,航行器主体1呈一字型;
步骤3.1、若两个时刻航行器的工作环境没有发生变化,则航行器的工作模式不需要发生变化;
步骤3.2、若t时刻航行器的工作环境为空中,而t+1时刻航行器的工作环境为水面,则航行器由空中下降到水面,切换航行器的工作模式,即由工作模式1切换为工作模式2;
步骤3.3、若t时刻航行器的工作环境为水面,而t+1时刻航行器的工作环境为水下,则航行器由水面下降到水下,切换航行器的工作模式,即由工作模式2切换为工作模式3;
步骤3.4、若t时刻航行器的工作环境为水下,而t+1时刻航行器的工作环境为水面,则航行器由水下上升到水面,切换航行器的工作模式,即由在工作模式3切换为工作模式2;
步骤3.5、若t时刻航行器的工作环境为水面,而t+1时刻航行器的工作环境为空中,则航行器由水面上升到空中,切换航行器的工作模式,即由在工作模式2切换为工作模式1。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811174522.8A CN109250106B (zh) | 2018-10-09 | 2018-10-09 | 一种基于压强传感器切换多栖航行器工作模式的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811174522.8A CN109250106B (zh) | 2018-10-09 | 2018-10-09 | 一种基于压强传感器切换多栖航行器工作模式的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109250106A true CN109250106A (zh) | 2019-01-22 |
CN109250106B CN109250106B (zh) | 2020-09-15 |
Family
ID=65045131
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811174522.8A Active CN109250106B (zh) | 2018-10-09 | 2018-10-09 | 一种基于压强传感器切换多栖航行器工作模式的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109250106B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1362348A (zh) * | 2001-01-02 | 2002-08-07 | 梁富泉 | 滑翔潜艇 |
CN104527953A (zh) * | 2015-01-26 | 2015-04-22 | 大连海事大学 | 一种圆碟形水下滑翔器及其工作方法 |
CN104724284A (zh) * | 2015-03-25 | 2015-06-24 | 朱威 | 一种多旋翼潜水无人飞行器及其控制方法 |
US9493235B2 (en) * | 2002-10-01 | 2016-11-15 | Dylan T X Zhou | Amphibious vertical takeoff and landing unmanned device |
US20180086450A1 (en) * | 2016-09-27 | 2018-03-29 | Young Chan Park | Amphibious flying vehicle |
-
2018
- 2018-10-09 CN CN201811174522.8A patent/CN109250106B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1362348A (zh) * | 2001-01-02 | 2002-08-07 | 梁富泉 | 滑翔潜艇 |
US9493235B2 (en) * | 2002-10-01 | 2016-11-15 | Dylan T X Zhou | Amphibious vertical takeoff and landing unmanned device |
CN104527953A (zh) * | 2015-01-26 | 2015-04-22 | 大连海事大学 | 一种圆碟形水下滑翔器及其工作方法 |
CN104724284A (zh) * | 2015-03-25 | 2015-06-24 | 朱威 | 一种多旋翼潜水无人飞行器及其控制方法 |
US20180086450A1 (en) * | 2016-09-27 | 2018-03-29 | Young Chan Park | Amphibious flying vehicle |
Also Published As
Publication number | Publication date |
---|---|
CN109250106B (zh) | 2020-09-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10589829B2 (en) | Gliding robotic fish navigation and propulsion | |
US20210206460A1 (en) | Navigation scene analysis systems and methods | |
CN205490863U (zh) | 一种基于惯性传感器的船载视频机械稳像系统 | |
CN107539475B (zh) | 一种空水多栖航行器的控制方法 | |
CN104724284A (zh) | 一种多旋翼潜水无人飞行器及其控制方法 | |
US20190016425A1 (en) | Mobile Underwater Docking System | |
CN107065898A (zh) | 一种水下无人船航行控制方法及系统 | |
Wang et al. | Modeling and simulation of the VideoRay Pro III underwater vehicle | |
JP7181723B2 (ja) | 海上探索システム、無人飛行体、及び無人飛行方法 | |
CN102975835A (zh) | 海水活塞调节式滑翔式潜水器 | |
CN110803270A (zh) | Auv的浮力调节装置及控制方法 | |
CN110282102A (zh) | 圆饼型无人水下滑翔声学探测器 | |
Nishida et al. | Hovering type AUV “Tuna-Sand” and its surveys on Smith caldera in Izu-Ogasawara ocean area | |
AU2018389953B2 (en) | Method for controlling the buoyancy of a submarine vehicle | |
CN111831003B (zh) | 一种柴电混合动力无人航行器及其姿态调整方法 | |
CN109250106A (zh) | 一种基于压强传感器切换多栖航行器工作模式的方法 | |
CN107117266B (zh) | 一种自平衡装置、无人航行器及其控制系统 | |
CN112093015A (zh) | 水下机器人 | |
CN215205324U (zh) | 一种基于浮沉子原理和温控气压法的潜水器 | |
Tanaka et al. | Underwater vehicle localization considering the effects of its oscillation | |
CN109240294A (zh) | 一种基于成分分析传感器切换多栖航行器工作模式的方法 | |
CN213262870U (zh) | 水下机器人 | |
CN208585396U (zh) | 一种仿生水下滑翔机器人 | |
RU183537U1 (ru) | Автономный необитаемый надводно-подводный аппарат планирующего типа ГЛАЙДЕР-БОТ | |
Setyawan et al. | Noise Removal in The IMU Sensor Using Exponential Moving Average with Parameter Selection in Remotely Operated Vehicle (ROV) |
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 |