CN114274719B - Mode self-adaptive switching method of amphibious unmanned vehicle - Google Patents
Mode self-adaptive switching method of amphibious unmanned vehicle Download PDFInfo
- Publication number
- CN114274719B CN114274719B CN202210024457.0A CN202210024457A CN114274719B CN 114274719 B CN114274719 B CN 114274719B CN 202210024457 A CN202210024457 A CN 202210024457A CN 114274719 B CN114274719 B CN 114274719B
- Authority
- CN
- China
- Prior art keywords
- amphibious
- vehicle
- unmanned vehicle
- amphibious 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.)
- Active
Links
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
技术领域Technical field
本发明涉及一种水陆两栖无人车的模式自适应切换方法,属于车辆工程和船舶工业技术领域。The invention relates to a mode adaptive switching method for an amphibious unmanned vehicle, and belongs to the technical fields of vehicle engineering and shipbuilding industry.
背景技术Background technique
水陆两栖车是一种兼备水、陆双重行驶功能,可以完成水下探测、近海登陆等功能的特种车辆,在特有的地理环境中具有不可替代的作用。目前,水陆两栖车正朝着轻量化、无人化的方向发展。然而由于水陆两栖车在水中和陆地上的工作要求不同,其自身的结构需要随着环境的改变发生相应的变化。因此现有的水陆两栖无人车往往无法实现真正的自主化,一般需要人在环远程控制。针对现有水陆两栖无人车无法实现水陆模式自主切换的现状,有必要发明一种可以根据周围环境自动改变自身模式的水陆两栖无人车模式自适应切换方法,从而进一步提高水陆两栖无人车的自主性和对环境的适应能力。The amphibious vehicle is a special vehicle that has both water and land driving functions and can complete underwater detection, offshore landing and other functions. It plays an irreplaceable role in the unique geographical environment. At present, amphibious vehicles are developing in the direction of lightweight and unmanned vehicles. However, due to the different working requirements of amphibious vehicles in water and on land, their own structures need to change accordingly as the environment changes. Therefore, existing amphibious unmanned vehicles often cannot achieve true autonomy and generally require human-in-the-loop remote control. In view of the current situation that existing amphibious unmanned vehicles cannot realize autonomous switching between amphibious and land modes, it is necessary to invent an adaptive switching method for amphibious unmanned vehicles that can automatically change its own mode according to the surrounding environment, thereby further improving the amphibious unmanned vehicles. autonomy and adaptability to the environment.
发明内容Contents of the invention
本发明为了解决现有的水陆两栖无人车自主功能有限,在水陆交界面处需要人员实时操控切换两栖无人车模式的问题,提出一种新型的模式自适应切换方法。该方法基于水陆两栖无人车在陆地、水面和水下三种不同工作环境下的结构特征模型,搭建了全方位的模式自适应切换方法,从而提高了水陆两栖模式自主能力,大大减轻了操控人员的负担。本发明能够应用于船舶工业技术领域、水陆两栖无人车辆技术领域。In order to solve the problem that existing amphibious unmanned vehicles have limited autonomous functions and require real-time human control and switching of amphibious unmanned vehicle modes at the amphibious interface, the present invention proposes a new mode adaptive switching method. This method is based on the structural characteristics model of amphibious unmanned vehicles in three different working environments of land, water and underwater, and builds a comprehensive mode adaptive switching method, thereby improving the autonomy of amphibious modes and greatly reducing the control personnel burden. The invention can be applied to the technical field of shipbuilding industry and the technical field of amphibious unmanned vehicles.
一种水陆两栖无人车的模式自适应切换方法,包括如下步骤:A mode adaptive switching method for amphibious unmanned vehicles, including the following steps:
步骤一、确定水陆两栖无人车在陆上、水面和水下环境不同环境下,车身关键变形机构的工作状态;所述车身关键变形机构包括:履带、喷水推进装置和浮标;Step 1. Determine the working status of the key deformation mechanisms of the body of the amphibious unmanned vehicle in different environments on land, water and underwater. The key deformation mechanisms of the body include: crawler tracks, water jet propulsion devices and buoys;
当水陆两栖无人车在陆上工作时,履带处于伸出状态,喷水推进装置收至车身内部,浮标处于收线状态紧吸在车身顶部。当水陆两栖无人车在水面上工作时,履带处于收起状态,喷水推进装置展开,浮标处于收线状态。当水陆两栖无人车在水下工作时,履带处于收起状态,喷水推进装置展开,浮标处于放线状态。When the amphibious unmanned vehicle is working on land, the crawler tracks are in an extended state, the water-jet propulsion device is retracted into the body, and the buoy is in a retracted state and is tightly sucked to the top of the body. When the amphibious unmanned vehicle is working on the water, the tracks are retracted, the water jet propulsion device is deployed, and the buoy is in the retracted state. When the amphibious unmanned vehicle is working underwater, the tracks are retracted, the water-jet propulsion device is deployed, and the buoy is released.
步骤二、利用各类装置进行数据采集。所述数据包括:周围环境信息、导航定位信息、水深、湿度。采集到的数据传递给车内计算机控制系统,同时利用浮标与外界通讯,检验数据格式并保存在数据库中。Step 2: Use various devices to collect data. The data includes: surrounding environment information, navigation and positioning information, water depth, and humidity. The collected data is transmitted to the computer control system in the vehicle. At the same time, the buoy is used to communicate with the outside world, the data format is checked and stored in the database.
步骤三、利用信息识别算法对步骤二中保存的数据进行噪声检测并剔除无关数据。经过对不同类型数据的整理、分类和识别,得到对应的环境信息,由此判断水陆两栖无人车所处的环境状态,同时向车内电控系统输出环境状态结果。Step 3: Use the information recognition algorithm to detect noise on the data saved in Step 2 and eliminate irrelevant data. After sorting, classifying and identifying different types of data, the corresponding environmental information is obtained, thereby judging the environmental status of the amphibious unmanned vehicle, and at the same time outputting the environmental status results to the electronic control system in the vehicle.
步骤四、根据步骤三中输入到电控系统的环境状态结果,驱动步骤一中的变形机构,完成水陆两栖无人车模式切换。切换完成后,水陆两栖无人车利用浮标与外界进行通讯并输出周围环境信息。Step 4: According to the environmental state results input to the electronic control system in Step 3, drive the deformation mechanism in Step 1 to complete the amphibious unmanned vehicle mode switching. After the switch is completed, the amphibious unmanned vehicle uses the buoy to communicate with the outside world and output surrounding environment information.
实现所述方法的装置,包括:可自动收放线的浮标1、转向推进器2、喷水推进器3、履带4、声呐9,压力传感器10、姿态传感器11和湿度传感器12;The device for implementing the method includes: a buoy 1 that can automatically retract and release a line, a steering thruster 2, a water jet thruster 3, a crawler track 4, a sonar 9, a pressure sensor 10, an attitude sensor 11 and a humidity sensor 12;
所述浮标1包含了5G通讯模块5、北斗导航模块6、TOF摄像头7和激光雷达8;所述浮标的主要作用为获取陆地和水面的环境信号,同时与外界遥控系统和操控人员进行通讯;The buoy 1 includes a 5G communication module 5, a Beidou navigation module 6, a TOF camera 7 and a laser radar 8; the main function of the buoy is to obtain environmental signals on land and water, and at the same time communicate with external remote control systems and operators;
所述压力传感器10、姿态传感器11和湿度传感器12用于获取周围环境信息和监控水陆两栖无人车自身状态;The pressure sensor 10, attitude sensor 11 and humidity sensor 12 are used to obtain surrounding environment information and monitor the status of the amphibious unmanned vehicle;
有益效果:Beneficial effects:
1.本发明的水陆两栖无人车的模式自适应切换方法,克服了传统的无人两栖无人车在水陆交界面处需要操控者遥控的缺点,可以通过一系列感知设备和智能算法,独立进行水陆模式切换,减轻了操控者的工作量。1. The mode adaptive switching method of the amphibious and unmanned amphibious vehicle of the present invention overcomes the shortcomings of the traditional unmanned amphibious and unmanned vehicle that require remote control by the operator at the amphibious and land interface. It can independently control the mode through a series of sensing devices and intelligent algorithms. Switching between water and land modes reduces the workload of the operator.
2.本发明的水陆两栖无人车模式自适应切换方法,当其在陆上巡逻时,内部搭载的激光雷达通过感知周围环境对两栖无人车内控制系统下达指令,可以规划自身下一步路线并保存在数据库中,进一步地提升了水陆两栖无人车的自主性。2. According to the adaptive switching method of the amphibious unmanned vehicle mode of the present invention, when the amphibious unmanned vehicle is patrolling on land, the internal lidar sends instructions to the control system in the amphibious unmanned vehicle by sensing the surrounding environment, and can plan its next route. And stored in the database, further improving the autonomy of amphibious unmanned vehicles.
3.本发明的水陆两栖无人车模式自适应切换方法,当其在水下工作时,前视声呐和侧扫声呐主动探测周围环境,可以对水下环境进行建模、监测等,拓展了水陆两栖无人车的应用场景。3. The amphibious unmanned vehicle mode adaptive switching method of the present invention, when it works underwater, forward-looking sonar and side-scanning sonar actively detect the surrounding environment, and can model and monitor the underwater environment, etc., expanding the scope of Application scenarios of amphibious unmanned vehicles.
4.本发明的水陆两栖无人车模式自适应切换方法,在特殊情况发生时,可以根据同步的数据库便于人员确认无人车的位置和环境信息,进一步提升了水陆两栖无人车的安全系数。4. The adaptive switching method of the amphibious unmanned vehicle mode of the present invention can facilitate personnel to confirm the location and environmental information of the unmanned vehicle based on the synchronized database when special circumstances occur, further improving the safety factor of the amphibious unmanned vehicle. .
5.本发明的水陆两栖无人车的模式自适应切换方法,可以在不同型号的两栖平台上搭建,可以最大限度地适应实际地形地貌和工作需求。5. The mode adaptive switching method of the amphibious unmanned vehicle of the present invention can be built on different types of amphibious platforms, and can adapt to the actual terrain and work needs to the maximum extent.
附图说明Description of the drawings
图1为本发明的实施例中采用的一种水陆两栖无人车变形机构示意图;Figure 1 is a schematic diagram of a deformation mechanism of an amphibious unmanned vehicle used in an embodiment of the present invention;
图2为本发明的实施例中两栖无人车搭载的浮标内部结构示意图;Figure 2 is a schematic diagram of the internal structure of the buoy mounted on the amphibious unmanned vehicle in the embodiment of the present invention;
图3为本发明的实施例中两栖无人车搭载的两栖无人车车身结构示意图;Figure 3 is a schematic structural diagram of the amphibious unmanned vehicle body mounted on the amphibious unmanned vehicle in an embodiment of the present invention;
图4为本发明的实施例中的模式自适应切换方法环境信息检测流程图;Figure 4 is an environmental information detection flow chart of the mode adaptive switching method in an embodiment of the present invention;
图5为本发明的实施例中的模式自适应切换方法中状态切换流程图。Figure 5 is a flow chart of state switching in the mode adaptive switching method in the embodiment of the present invention.
附图标记说明:1-1——可自动收放浮标的放开状态、1-2——可自动收放浮标的吸附状态、2——转向推进器、3——喷水推进器、4——履带、5——5G通讯模块、6——北斗导航模块、7——TOF摄像头、8——激光雷达、9——声呐模块、10——压力传感器、11——姿态传感器、12——湿度传感器。Explanation of reference signs: 1-1 - the released state of the automatically retractable and retractable buoy, 1-2 - the adsorption state of the automatically retractable and retractable buoy, 2 - steering propeller, 3 - water jet propeller, 4 ——Crawler, 5—5G communication module, 6—Beidou navigation module, 7—TOF camera, 8—Lidar, 9—Sonar module, 10—Pressure sensor, 11—Attitude sensor, 12— -Humidity Sensor.
具体实施方式Detailed ways
为了更好的说明本发明的目的和优点,下面结合附图和实例对发明内容做进一步说明。显然,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所得到的所有其他方式,都属于本发明所保护的范围。In order to better illustrate the purpose and advantages of the present invention, the content of the invention will be further described below in conjunction with the accompanying drawings and examples. Obviously, the described embodiments are only some of the embodiments of the present invention, but not all of the embodiments. Based on the embodiments of the present invention, all other methods obtained by those of ordinary skill in the art without creative work fall within the scope of protection of the present invention.
以下结合附图和具体实施例对本发明进行详细说明。The present invention will be described in detail below with reference to the accompanying drawings and specific embodiments.
一种水陆两栖无人车的模式自适应切换方法,包括如下步骤:A mode adaptive switching method for amphibious unmanned vehicles, including the following steps:
步骤一、确定水陆两栖无人车在陆上、水面和水下环境不同环境下,车身关键变形机构的工作状态;所述车身关键变形机构包括:履带、喷水推进装置和浮标;Step 1. Determine the working status of the key deformation mechanisms of the body of the amphibious unmanned vehicle in different environments on land, water and underwater. The key deformation mechanisms of the body include: crawler tracks, water jet propulsion devices and buoys;
当水陆两栖无人车在陆上工作时,履带处于伸出状态,喷水推进装置收至车身内部,浮标处于收线状态紧吸在车身顶部。当水陆两栖无人车在水面上工作时,履带处于收起状态,喷水推进装置展开,浮标处于收线状态。当水陆两栖无人车在水下工作时,履带处于收起状态,喷水推进装置展开,浮标处于放线状态。When the amphibious unmanned vehicle is working on land, the crawler tracks are in an extended state, the water-jet propulsion device is retracted into the body, and the buoy is in a retracted state and is tightly sucked to the top of the body. When the amphibious unmanned vehicle is working on the water, the tracks are retracted, the water jet propulsion device is deployed, and the buoy is in the retracted state. When the amphibious unmanned vehicle is working underwater, the tracks are retracted, the water-jet propulsion device is deployed, and the buoy is released.
步骤二、利用各类装置进行数据采集。所述数据包括:周围环境信息、导航定位信息、水深、湿度。采集到的数据传递给车内计算机控制系统,同时利用浮标与外界通讯,检验数据格式并保存在数据库中。Step 2: Use various devices to collect data. The data includes: surrounding environment information, navigation and positioning information, water depth, and humidity. The collected data is transmitted to the computer control system in the vehicle. At the same time, the buoy is used to communicate with the outside world, the data format is checked and stored in the database.
步骤三、利用信息识别算法对步骤2中保存的数据进行噪声检测并剔除无关数据。经过对不同类型数据的整理、分类和识别,得到对应的环境信息,由此判断水陆两栖无人车所处的环境状态,同时向车内电控系统输出环境状态结果。Step 3: Use the information recognition algorithm to detect noise on the data saved in Step 2 and eliminate irrelevant data. After sorting, classifying and identifying different types of data, the corresponding environmental information is obtained, thereby judging the environmental status of the amphibious unmanned vehicle, and at the same time outputting the environmental status results to the electronic control system in the vehicle.
步骤四、根据步骤三中输入到电控系统的环境状态结果,驱动步骤一中的变形机构,完成水陆两栖无人车模式切换。切换完成后,水陆两栖无人车利用浮标与外界进行通讯并输出周围环境信息。Step 4: According to the environmental state results input to the electronic control system in Step 3, drive the deformation mechanism in Step 1 to complete the amphibious unmanned vehicle mode switching. After the switch is completed, the amphibious unmanned vehicle uses the buoy to communicate with the outside world and output surrounding environment information.
实现上述方法的装置,包括可自动收放线的浮标1、转向推进器2、喷水推进器3、履带4、声呐9,压力传感器10、姿态传感器11和湿度传感器12;The device that implements the above method includes a buoy 1 that can automatically retract and release a line, a steering thruster 2, a water jet thruster 3, a crawler track 4, a sonar 9, a pressure sensor 10, an attitude sensor 11 and a humidity sensor 12;
所述浮标1包含了5G通讯模块5、北斗导航模块6、TOF摄像头7和激光雷达8。The buoy 1 includes a 5G communication module 5, a Beidou navigation module 6, a TOF camera 7 and a laser radar 8.
所述浮标1位于车身顶部,主要作用为获取陆地和水面的环境信号,同时与外界遥控系统和操控人员进行通讯;The buoy 1 is located on the top of the vehicle body, and its main function is to obtain environmental signals from land and water, and at the same time communicate with external remote control systems and operators;
所述转向推进器2位于车身前端,主要作用为控制水陆两栖无人车在水下进行转向;The steering propeller 2 is located at the front end of the vehicle body, and its main function is to control the amphibious unmanned vehicle to steer underwater;
所述喷水推进器3位于车身尾端,是水陆两栖无人车在水中的动力来源;The water jet propeller 3 is located at the rear end of the vehicle body and is the power source for the amphibious unmanned vehicle in the water;
所述履带4位于车身底部,是水陆两栖无人车在陆地上的行走机构;The crawler tracks 4 are located at the bottom of the vehicle body and are the walking mechanism of the amphibious unmanned vehicle on land;
所述5G实时通讯模块5布置于水陆两栖无人车浮标中,将水下信号、环境风速风向、摄像头图像以及导航定位位置实时传输给外界;The 5G real-time communication module 5 is arranged in an amphibious unmanned vehicle buoy to transmit underwater signals, environmental wind speed and direction, camera images, and navigation and positioning positions to the outside world in real time;
所述北斗导航模块6,布置于水陆两栖无人车浮标中,支持北斗导航、北斗短报文通信,能够自动回传位置信息;The Beidou navigation module 6 is arranged in an amphibious unmanned vehicle buoy, supports Beidou navigation, Beidou short message communication, and can automatically return location information;
所述TOF摄像头7,布置于水陆两栖无人车浮标中,基于视差原理利用成像设备从不同的位置获取被测物体的两幅图像,通过计算图像对应点间的位置偏差,来获取物体三维几何信息;The TOF camera 7 is arranged in an amphibious unmanned vehicle buoy. It uses imaging equipment to obtain two images of the measured object from different positions based on the principle of parallax, and obtains the three-dimensional geometry of the object by calculating the position deviation between corresponding points in the image. information;
所述激光雷达8,布置于水陆两栖无人车浮标中,是以发射激光束探测目标的位置、速度等特征量的雷达系统。水陆两栖无人车在陆地上和水面上时,向环境目标发射探测信号,根据环境目标反射回来的信号就可获得环境的有关信息;The lidar 8 is arranged in an amphibious unmanned vehicle buoy and is a radar system that emits a laser beam to detect characteristic quantities such as the position and speed of a target. When the amphibious unmanned vehicle is on land or water, it emits detection signals to environmental targets, and relevant information about the environment can be obtained based on the signals reflected back by the environmental targets;
所述声呐模块9,布置于水陆两栖无人车车身正前方。当水陆两栖无人车在水中工作时,声呐模块用于探测水下环境;The sonar module 9 is arranged directly in front of the amphibious unmanned vehicle body. When the amphibious unmanned vehicle works in the water, the sonar module is used to detect the underwater environment;
所述压力传感器10,布置于水陆两栖无人车车身前方,用于监测压力值并计算深度信息;The pressure sensor 10 is arranged in front of the amphibious unmanned vehicle body and is used to monitor pressure values and calculate depth information;
所述姿态传感器11,布置于水陆两栖无人车车身前方,可以实时输出以四元数、欧拉角等表示的零漂移三维姿态数据;The attitude sensor 11 is arranged in front of the amphibious unmanned vehicle body and can output zero-drift three-dimensional attitude data expressed in quaternions, Euler angles, etc. in real time;
所述湿度传感器12,布置于水陆两栖无人车车身前方。通过湿度传感器测得数值,可以反映水陆两栖无人车所处环境状态。The humidity sensor 12 is arranged in front of the amphibious unmanned vehicle body. The value measured by the humidity sensor can reflect the environmental status of the amphibious unmanned vehicle.
一种水陆两栖无人车的模式自适应切换方法,具体包括下述步骤:A mode adaptive switching method for amphibious unmanned vehicles, specifically including the following steps:
步骤一、确定水陆两栖无人车在陆上、水面和水下环境不同环境下,车身关键变形机构的工作状态;所述车身关键变形机构包括:履带、喷水推进装置和浮标;Step 1. Determine the working status of the key deformation mechanisms of the body of the amphibious unmanned vehicle in different environments on land, water and underwater. The key deformation mechanisms of the body include: crawler tracks, water jet propulsion devices and buoys;
当水陆两栖无人车在陆上工作时,履带处于伸出状态,喷水推进装置收至车身内部,浮标处于收线状态紧吸在车身顶部。当水陆两栖无人车在水面上工作时,履带处于收起状态,喷水推进装置展开,浮标处于收线状态。当水陆两栖无人车在水下工作时,履带处于收起状态,喷水推进装置展开,浮标处于放线状态。When the amphibious unmanned vehicle is working on land, the crawler tracks are in an extended state, the water-jet propulsion device is retracted into the body, and the buoy is in a retracted state and is tightly sucked to the top of the body. When the amphibious unmanned vehicle is working on the water, the tracks are retracted, the water jet propulsion device is deployed, and the buoy is in the retracted state. When the amphibious unmanned vehicle is working underwater, the tracks are retracted, the water-jet propulsion device is deployed, and the buoy is released.
步骤二、利用各类装置进行数据采集。所述数据包括:导航定位信息、周围环境信息、水深、水压力、湿度等。采集到的数据传递给车内计算机控制系统,检验数据格式并保存在数据库中。同时,利用浮标与外界进行通讯,同步数据库信息。Step 2: Use various devices to collect data. The data includes: navigation and positioning information, surrounding environment information, water depth, water pressure, humidity, etc. The collected data is passed to the in-vehicle computer control system, where the data format is checked and stored in the database. At the same time, buoys are used to communicate with the outside world and synchronize database information.
北斗导航定位模块,是两栖无人车自主工作的基础,为两栖无人车的实时定位和路线控制等提供了重要保障。北斗导航定位模块每隔1s都会接收北斗卫星信号,更新地图位置向计算机系统输出GetLocation(X,Y,Z)。在空旷的野外环境,北斗导航的测量准确度通常能达到2-3米,完全可以为两栖无人车模式切换提供环境信息参考。The Beidou navigation and positioning module is the basis for the autonomous work of amphibious unmanned vehicles and provides important guarantees for the real-time positioning and route control of amphibious unmanned vehicles. The Beidou navigation and positioning module receives Beidou satellite signals every 1 second, updates the map position and outputs GetLocation(X,Y,Z) to the computer system. In an open wild environment, the measurement accuracy of Beidou navigation can usually reach 2-3 meters, which can provide environmental information reference for amphibious unmanned vehicle mode switching.
两栖车在陆上工作时,采用TOF摄像头与激光雷达相配合的方式实现两栖无人车的环境信息感知。激光雷达用于获得较大范围的粗糙环境地貌信息,采用脉冲测距法,通过发射与接受激光的时间差Δt与光速c相乘,获取两栖无人车对某一目标物i的距离Li。When the amphibious vehicle works on land, it uses TOF cameras and lidar to realize the environmental information perception of the amphibious unmanned vehicle. Lidar is used to obtain a large range of rough environmental landform information. It uses the pulse ranging method and multiplies the time difference Δt between transmitting and receiving laser light with the speed of light c to obtain the distance L i of the amphibious unmanned vehicle to a certain target i.
在两栖车运动过程中,激光雷达与目标物的所处相对位置会发生变化,相邻时刻经比对可得到与目标物i的角度θi。During the movement of the amphibious vehicle, the relative position of the lidar and the target object will change. The angle θ i with the target object i can be obtained by comparing adjacent moments.
TOF摄像头的主要功能为获取两栖无人车周身环境细节信息。通过发射和返回光的相位差Δψ、波长λ,光速c和已返回波长个数,得到某一目标物j的距离sj。The main function of the TOF camera is to obtain detailed information about the surrounding environment of the amphibious unmanned vehicle. Through the phase difference Δψ of the emitted and returned light, the wavelength λ, the speed of light c and the number of returned wavelengths, the distance s j of a certain target j can be obtained.
对陆上环境进行建图,将Li、sj、θi汇总后得到陆上环境信息矩阵[L S θ]。The terrestrial environment is mapped, and L i , s j , and θ i are summarized to obtain the terrestrial environment information matrix [LS θ].
由于激光雷达和TOF摄像头无法在水下工作,两栖无人车需要利用声波在水中的传播和反射特性,通过声呐模块的电声转换和信息处理技术,进行水下两栖无人车导航和对水下障碍物进行测距,从而实现对水下目标的精准探测。利用声波速度w和接收到的声波时延τ,可计算出目标物k与两栖无人车之间的距离dk。Since lidar and TOF cameras cannot work underwater, amphibious unmanned vehicles need to make use of the propagation and reflection characteristics of sound waves in water and use the electroacoustic conversion and information processing technology of sonar modules to conduct underwater amphibious unmanned vehicle navigation and water navigation. Measure distances from obstacles below to achieve accurate detection of underwater targets. Using the sound wave speed w and the received sound wave delay τ, the distance d k between the target k and the amphibious unmanned vehicle can be calculated.
水下环境方位角探测中,采用MUSIC算法,利用声呐阵列信号处理结果X(t)、回波到达信号S(t)和噪声N(t),即可得到目标方位角矩阵A。In underwater environment azimuth detection, the MUSIC algorithm is used, and the target azimuth matrix A can be obtained by using the sonar array signal processing result X(t), echo arrival signal S(t) and noise N(t).
X(t)=AS(t)+N(t)X(t)=AS(t)+N(t)
A=[α1,α2,α3...αn]A=[α 1 , α 2 , α 3 ... α n ]
对水下环境进行建图,将dk、A汇总后得到水下环境信息矩阵[D A]。The underwater environment is mapped, and d k and A are summarized to obtain the underwater environment information matrix [DA].
当水吸附在湿度传感器的感湿膜上时,元件的电阻率和电阻值都发生变化,利用这一特性判断两栖无人车状态。当湿度传感器判定两栖无人车处于吃水状态时,将状态变量SV赋值为1;反之,SV=0。When water is adsorbed on the moisture-sensing film of the humidity sensor, the resistivity and resistance value of the element change. This characteristic is used to determine the status of the amphibious unmanned vehicle. When the humidity sensor determines that the amphibious unmanned vehicle is in a draft state, the state variable SV is assigned a value of 1; otherwise, SV=0.
根据压力传感器测得压强P与水的密度和重力加速度比值,计算出水深h。According to the ratio of the pressure P measured by the pressure sensor to the density of water and the acceleration of gravity, the water depth h is calculated.
根据上述信息,将每一时刻两栖无人车的位置信息GetLocation(X,Y,Z)、激光雷达与TOF摄像头测得陆上环境信息矩阵[L S θ]、声呐模块测得水下环境信息矩阵[D A]、状态变量SV和深度信息h保存在数据库中。Based on the above information, the amphibious unmanned vehicle's position information GetLocation(X, Y, Z), the land environment information matrix [L S θ] measured by the lidar and TOF camera at each moment, and the underwater environment information matrix measured by the sonar module are [D A], state variable SV and depth information h are stored in the database.
步骤三、利用信息识别算法对步骤2数据库中保存的数据进行目标和环境噪声进行检测。经过预处理与特征提取后,得到两栖车周围环境信息。如附图4所示,经过一系列逻辑判断,向两栖无人车电控系统输出环境信息EI判定结果。Step 3: Use the information recognition algorithm to detect targets and environmental noise from the data saved in the database in Step 2. After preprocessing and feature extraction, the surrounding environment information of the amphibious vehicle is obtained. As shown in Figure 4, after a series of logical judgments, the environmental information EI judgment results are output to the amphibious unmanned vehicle electronic control system.
采用卡尔曼滤波对激光雷达和TOF摄像头数据进行融合,以激光雷达测得位置L和TOF摄像头测得位置S为例,记k-1时刻的状态向量:Kalman filtering is used to fuse lidar and TOF camera data. Taking the position L measured by lidar and the position S measured by TOF camera as an example, record the state vector at time k-1:
Xk-1=(l,s)T X k-1 = (l, s) T
引入预测矩阵Fk,使得k时刻的状态向量为:Introduce the prediction matrix F k so that the state vector at time k is:
Xk=FkXk-1+Bkuk X k =F k X k-1 +B k u k
其中Bk是k时刻两栖车外部施加的控制矩阵,如制动、加速等;uk是控制向量。Among them, B k is the control matrix applied externally to the amphibious vehicle at time k, such as braking, acceleration, etc.; u k is the control vector.
k时刻的不确定性,协方差矩阵Pk为:The uncertainty at time k, the covariance matrix P k is:
其中Qk是一个不确定性的高斯分布,如履带打滑、地表障碍物凸起等不可预测因素。Among them, Q k is a Gaussian distribution of uncertainty, such as track slippage, surface obstacle bulges and other unpredictable factors.
引入线性变化矩阵Hk,将激光雷达与TOF摄像头观测结果的尺度单位进行统一;引入传感器噪声Rk,描述传感器的不确定性;引入观察结果分布zk,引入卡尔曼增益矩阵K。经过线性变换后得到修正值X′k、P′k和K′。The linear change matrix H k is introduced to unify the scale units of the lidar and TOF camera observation results; the sensor noise R k is introduced to describe the uncertainty of the sensor; the observation result distribution z k is introduced, and the Kalman gain matrix K is introduced. After linear transformation, the correction values X′ k , P′ k and K′ are obtained.
X′k=xk+K′(zk-HkXk) X′k = xk +K′( zk - HkXk )
P′k=(1-K′Hk)Pk P′ k =(1-K′H k )P k
按照以上流程,将L与S值不断进行修正迭代,进行数据融合,最终得到两栖无人车周围环境信息的识别和建图。According to the above process, the L and S values are continuously revised and iterated, and data fusion is performed, and finally the identification and mapping of the surrounding environment information of the amphibious unmanned vehicle are obtained.
将融合后的三维地图数据库,与北斗导航得到的GetLocation(X,Y,Z)进行回环检测,检查是否出现错误(如定位在海中的两栖车在自身建图的数据库显示为陆地)。Perform a loopback test on the fused three-dimensional map database with the GetLocation(X,Y,Z) obtained by Beidou Navigation to check whether there are any errors (for example, an amphibious vehicle positioned in the sea displays land as land in its own mapping database).
当地图数据库与导航定位系统没有明显的出入时,计算机系统根据地图信息判断两栖车是否处于陆地环境中。如果两栖车处于陆地环境,计算机系统内环境信息EI赋值为“陆地”。否,调用数据库中的SV和h信息,判断两栖车是否处于水面上。如果是,EI赋值为“水面”;否,EI赋值为“水下”。When there is no obvious discrepancy between the map database and the navigation and positioning system, the computer system determines whether the amphibious vehicle is in a land environment based on the map information. If the amphibious vehicle is in a land environment, the environmental information EI in the computer system is assigned the value "land". No, call the SV and h information in the database to determine whether the amphibious vehicle is on the water. If yes, the EI value is "water surface"; if not, the EI value is "underwater".
步骤四、根据步骤三中的环境信息结果EI,利用步骤一中的变形控制机构,驱动两栖车完成状态切换。利用姿态传感器检测水陆两栖车实时姿态,同时用于辅助两栖车模式切换。两栖车模式切换完成后,利用浮标与外界进行通讯并输出自身状态,如附图5所示。Step 4: According to the environmental information result EI in step 3, use the deformation control mechanism in step 1 to drive the amphibious vehicle to complete the state switch. The attitude sensor is used to detect the real-time attitude of the amphibious vehicle and is also used to assist the mode switching of the amphibious vehicle. After the amphibious vehicle mode switching is completed, the buoy is used to communicate with the outside world and output its own status, as shown in Figure 5.
当EI为“陆地”时,计算机系统对两栖无人车的驱动机构下达指令,首先利用电磁铁将浮标吸附在车身上方,根据两栖无人车内激光雷达和TOF摄像头实时发送的地形地貌信号,规划两栖无人车下一步巡逻路线并保存在数据库中。When EI is "land", the computer system issues instructions to the driving mechanism of the amphibious unmanned vehicle. First, an electromagnet is used to adsorb the buoy above the vehicle body. Based on the terrain signals sent in real time by the lidar and TOF camera in the amphibious unmanned vehicle, Plan the next patrol route of the amphibious unmanned vehicle and save it in the database.
当EI由“陆地”变化为“水面”时,计算机电控系统会降低两栖无人车速度,展开车身喷水推进器和转向推进器,进入水陆交界面后缓慢收起履带机构并调用车身内部的湿度传感器监测两栖无人车内部是否出现渗水情况,工作一段时间未发现报警信号后实现水陆模式切换。When the EI changes from "land" to "water", the computer electronic control system will reduce the speed of the amphibious unmanned vehicle, deploy the body's water jet thrusters and steering thrusters, and after entering the water-land interface, slowly retract the crawler mechanism and call the interior of the body The humidity sensor monitors whether there is water seepage inside the amphibious unmanned vehicle. After working for a period of time and no alarm signal is found, the amphibious unmanned vehicle can switch between water and land modes.
当EI由“水面”改变为“水下”后,水陆两栖无人车会切断电磁铁电源释放浮标,同时调整两栖无人车重心位置,收起翼板减小排水体积,声呐模块开始工作,下沉的根据深度信息h控制浮标电机释放电缆,浮标持续监控水面环境信息并向远程遥控端发送车内传感器信号,完成潜水状态切换。在水下工作时,远程遥控端通过与漂浮在水面上的浮标通信,实时掌握水下情况和车身状态,如车内湿度、水深压力、车身压力等,将其作为指挥两栖无人车的依据。When the EI changes from "water surface" to "underwater", the amphibious unmanned amphibious vehicle will cut off the electromagnet power to release the buoy. At the same time, it will adjust the center of gravity of the amphibious unmanned vehicle, retract the wings to reduce the drainage volume, and the sonar module will start working. The sinking controls the buoy motor to release the cable based on the depth information h. The buoy continuously monitors the water surface environment information and sends in-vehicle sensor signals to the remote control terminal to complete the diving state switch. When working underwater, the remote control terminal communicates with the buoy floating on the water to grasp the underwater situation and body status in real time, such as the humidity in the car, water depth pressure, body pressure, etc., and use this as the basis for commanding the amphibious unmanned vehicle. .
当EI由“水下”变为“水面”时,各类传感器设备监控信息发送至计算机系统,并根据h值实时调节浮标电机电缆收缩速度。到达水面后两栖无人车接通浮标电磁铁回路紧吸浮标,同时检查车内各部件工作状态,完成水面状态切换并向远程遥控端反馈信号。When EI changes from "underwater" to "surface", monitoring information from various sensor equipment is sent to the computer system, and the contraction speed of the buoy motor cable is adjusted in real time according to the h value. After arriving at the water surface, the amphibious unmanned vehicle connects the electromagnet circuit of the buoy and sucks the buoy tightly. At the same time, it checks the working status of each component in the vehicle, completes the water surface state switching, and feeds back signals to the remote control terminal.
当水陆两栖无人车登陆时,EI由“水面”变为“陆地”,驱动机构收紧浮标,伸出履带并收起推进器,完成整个水陆区域两栖无人车模式切换循环。When the amphibious unmanned vehicle lands, the EI changes from "water surface" to "land". The driving mechanism tightens the buoy, extends the track and retracts the propeller, completing the entire amphibious unmanned vehicle mode switching cycle in the amphibious area.
本发明为了解决现有的水陆两栖无人车自主功能有限,在水陆交界面处需要人员实时操控切换两栖无人车模式的问题,提出一种新型的模式自适应切换方法。该方法基于水陆两栖无人车在陆地、水面和水下三种不同工作环境下的结构特征模型,搭建了全方位的模式自适应切换方法,从而提高了水陆两栖模式自主能力,大大减轻了操控人员的负担。本发明能够应用于船舶工业技术领域、水陆两栖无人车辆技术领域。In order to solve the problem that existing amphibious unmanned vehicles have limited autonomous functions and require real-time human control and switching of amphibious unmanned vehicle modes at the amphibious interface, the present invention proposes a new mode adaptive switching method. This method is based on the structural characteristics model of amphibious unmanned vehicles in three different working environments of land, water and underwater, and builds a comprehensive mode adaptive switching method, thereby improving the autonomy of amphibious modes and greatly reducing the control personnel burden. The invention can be applied to the technical field of shipbuilding industry and the technical field of amphibious unmanned vehicles.
以上所述的具体描述,对发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施例而已,并不用于限定本发明的保护范围,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。The above-mentioned specific description further explains the purpose, technical solutions and beneficial effects of the invention in detail. It should be understood that the above-mentioned are only specific embodiments of the invention and are not intended to limit the protection of the invention. Any modifications, equivalent substitutions, improvements, etc. made within the spirit and principles of the present invention shall be included in the protection scope of the present invention.
Claims (1)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210024457.0A CN114274719B (en) | 2022-01-06 | 2022-01-06 | Mode self-adaptive switching method of amphibious unmanned vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210024457.0A CN114274719B (en) | 2022-01-06 | 2022-01-06 | Mode self-adaptive switching method of amphibious unmanned vehicle |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114274719A CN114274719A (en) | 2022-04-05 |
CN114274719B true CN114274719B (en) | 2023-11-10 |
Family
ID=80880704
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210024457.0A Active CN114274719B (en) | 2022-01-06 | 2022-01-06 | Mode self-adaptive switching method of amphibious unmanned vehicle |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114274719B (en) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115179703B (en) * | 2022-08-11 | 2024-06-18 | 东风越野车有限公司 | Amphibious vehicle amphibious driving mode switching time judging method and device and vehicle |
CN115402040A (en) * | 2022-09-07 | 2022-11-29 | 湖北汽车工业学院 | A driving mode automatic judgment and control method for an amphibious vehicle |
CN115451245B (en) * | 2022-09-20 | 2025-02-14 | 上海海事大学 | Amphibious drainage pipe in-water detection robot and control method thereof |
CN116165958A (en) * | 2023-04-25 | 2023-05-26 | 舜泰汽车有限公司 | Automatic driving system of amphibious special unmanned platform |
CN118092156B (en) * | 2024-01-15 | 2025-03-28 | 北京理工大学 | A method for identifying working conditions of an amphibious vehicle |
CN119142078B (en) * | 2024-11-18 | 2025-03-11 | 西北工业大学深圳研究院 | A method and device for autonomous decision-making of cross-domain maneuvering mode of amphibious vehicle |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100649554B1 (en) * | 2005-12-12 | 2006-11-27 | 디에스엠이 유텍 주식회사 | Underwater logistics delivery system using autonomous unmanned submersible |
CN106114095A (en) * | 2016-06-27 | 2016-11-16 | 中国石油大学(华东) | A kind of amphibious sniffing robot |
KR101815811B1 (en) * | 2017-07-18 | 2018-01-05 | (주)지엠아이그룹 | Amphibious Bus |
CN107839417A (en) * | 2017-10-17 | 2018-03-27 | 青岛中邦防务智能装备有限公司 | A kind of application method of amphibious unmanned boat caterpillar system |
CN207291544U (en) * | 2017-10-17 | 2018-05-01 | 青岛中邦防务智能装备有限公司 | A kind of amphibious unmanned boat |
KR101904906B1 (en) * | 2017-03-29 | 2018-11-28 | 공주대학교 산학협력단 | Automatic opening shutting apparatus of trailer for amphibious boat |
KR102094148B1 (en) * | 2018-10-19 | 2020-03-27 | 한화디펜스 주식회사 | Amphibious vehicle |
CN113147291A (en) * | 2021-04-14 | 2021-07-23 | 北京理工大学 | Amphibious cross-medium unmanned vehicle |
CN113524996A (en) * | 2021-08-10 | 2021-10-22 | 芜湖造船厂有限公司 | Amphibious vehicle |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB0128338D0 (en) * | 2001-11-27 | 2002-01-16 | Gibbs Int Tech Ltd | Amphibious vehicle |
-
2022
- 2022-01-06 CN CN202210024457.0A patent/CN114274719B/en active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100649554B1 (en) * | 2005-12-12 | 2006-11-27 | 디에스엠이 유텍 주식회사 | Underwater logistics delivery system using autonomous unmanned submersible |
CN106114095A (en) * | 2016-06-27 | 2016-11-16 | 中国石油大学(华东) | A kind of amphibious sniffing robot |
KR101904906B1 (en) * | 2017-03-29 | 2018-11-28 | 공주대학교 산학협력단 | Automatic opening shutting apparatus of trailer for amphibious boat |
KR101815811B1 (en) * | 2017-07-18 | 2018-01-05 | (주)지엠아이그룹 | Amphibious Bus |
CN107839417A (en) * | 2017-10-17 | 2018-03-27 | 青岛中邦防务智能装备有限公司 | A kind of application method of amphibious unmanned boat caterpillar system |
CN207291544U (en) * | 2017-10-17 | 2018-05-01 | 青岛中邦防务智能装备有限公司 | A kind of amphibious unmanned boat |
KR102094148B1 (en) * | 2018-10-19 | 2020-03-27 | 한화디펜스 주식회사 | Amphibious vehicle |
CN113147291A (en) * | 2021-04-14 | 2021-07-23 | 北京理工大学 | Amphibious cross-medium unmanned vehicle |
CN113524996A (en) * | 2021-08-10 | 2021-10-22 | 芜湖造船厂有限公司 | Amphibious vehicle |
Non-Patent Citations (1)
Title |
---|
基于动网格的两栖车航行姿态数值模拟;赵彬;张敏弟;剧冬梅;;兵工学报(第03期);412-420 * |
Also Published As
Publication number | Publication date |
---|---|
CN114274719A (en) | 2022-04-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114274719B (en) | Mode self-adaptive switching method of amphibious unmanned vehicle | |
US11505292B2 (en) | Perimeter ranging sensor systems and methods | |
EP3639104B1 (en) | Perimeter ranging sensor systems and methods | |
CN101436074B (en) | Autonomous Underwater Robot Using Simultaneous Localization and Mapping Approach | |
US20190361457A1 (en) | Autonomous and assisted docking systems and methods | |
CN103019179B (en) | Waterborne vessel reconnaissance system and method | |
US10773591B2 (en) | Video analytics based pilot safety devices | |
CN111290410A (en) | Millimeter wave radar-based automatic ship berthing and departing system and method | |
CN113124864A (en) | Water surface navigation method adopting machine vision and inertial navigation fusion | |
CN114488164A (en) | Underwater vehicle synchronous positioning and mapping method and underwater vehicle | |
CN115019412A (en) | Underwater AUV (autonomous underwater vehicle) submarine cable inspection system and method based on multiple sensors | |
CN113989350B (en) | Monitoring system for autonomous exploration of unmanned ships and three-dimensional reconstruction of unknown environments | |
CN111309010A (en) | Unmanned ship seabed terrain surveying and mapping control system based on bionic robot and control method thereof | |
JP2022145659A (en) | Coupling system between water surface relay machine and underwater vehicle, and operation method for the same | |
KR102652885B1 (en) | Control method of an underwater robot equipped with a multi-degree-of-freedom robot arm | |
CN110780303A (en) | Parametric array ice layer profile detection underwater robot and ice layer profile detection method | |
CN115686021A (en) | An unmanned vessel for marine cloud and fog observation | |
EP0772787B1 (en) | A system for underwater survey operations | |
Sawada et al. | Mapping and localization for autonomous ship using LiDAR SLAM on the sea | |
CN116540727A (en) | Autonomous berthing method for underactuated unmanned surface vehicle based on multi-sensor fusion positioning | |
Loebis et al. | Review of multisensor data fusion techniques and their application to autonomous underwater vehicle navigation | |
US12110086B2 (en) | Methods and systems for surveying using deep-water vessels | |
JP2001247085A (en) | Depth measuring method by diving machine | |
CN114061565B (en) | Unmanned ship SLAM and application method thereof | |
CN114879686A (en) | A robot system and control method for water diversion tunnel detection |
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 | ||
CB03 | Change of inventor or designer information |
Inventor after: Li Zeyang Inventor after: Chen Tairan Inventor after: Liu Haoran Inventor after: Huang Biao Inventor after: Wang Guoyu Inventor before: Chen Tairan Inventor before: Li Zeyang Inventor before: Liu Haoran Inventor before: Huang Biao Inventor before: Wang Guoyu |
|
CB03 | Change of inventor or designer information | ||
GR01 | Patent grant | ||
GR01 | Patent grant |