CN110737275A - ship navigation control system for realizing synchronous multi-ship entry and exit gate - Google Patents
ship navigation control system for realizing synchronous multi-ship entry and exit gate Download PDFInfo
- Publication number
- CN110737275A CN110737275A CN201911075333.XA CN201911075333A CN110737275A CN 110737275 A CN110737275 A CN 110737275A CN 201911075333 A CN201911075333 A CN 201911075333A CN 110737275 A CN110737275 A CN 110737275A
- Authority
- CN
- China
- Prior art keywords
- ship
- positioning
- navigation
- information
- module
- 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
- 230000001360 synchronised effect Effects 0.000 title claims description 14
- 238000004891 communication Methods 0.000 claims abstract description 59
- 238000012544 monitoring process Methods 0.000 claims abstract description 10
- 238000012546 transfer Methods 0.000 claims abstract description 9
- 230000006870 function Effects 0.000 claims description 20
- 230000005540 biological transmission Effects 0.000 claims description 11
- 238000000034 method Methods 0.000 claims description 8
- 230000004044 response Effects 0.000 claims description 7
- 230000003993 interaction Effects 0.000 claims description 6
- 238000012423 maintenance Methods 0.000 claims description 6
- 238000012545 processing Methods 0.000 claims description 6
- 230000008569 process Effects 0.000 claims description 5
- 238000010586 diagram Methods 0.000 description 7
- 238000013459 approach Methods 0.000 description 6
- 230000001105 regulatory effect Effects 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 5
- 238000005259 measurement Methods 0.000 description 5
- 230000003044 adaptive effect Effects 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000011161 development Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000002372 labelling Methods 0.000 description 2
- 230000006855 networking Effects 0.000 description 2
- RNFJDJUURJAICM-UHFFFAOYSA-N 2,2,4,4,6,6-hexaphenoxy-1,3,5-triaza-2$l^{5},4$l^{5},6$l^{5}-triphosphacyclohexa-1,3,5-triene Chemical compound N=1P(OC=2C=CC=CC=2)(OC=2C=CC=CC=2)=NP(OC=2C=CC=CC=2)(OC=2C=CC=CC=2)=NP=1(OC=1C=CC=CC=1)OC1=CC=CC=C1 RNFJDJUURJAICM-UHFFFAOYSA-N 0.000 description 1
- 230000001133 acceleration Effects 0.000 description 1
- XAGFODPZIPBFFR-UHFFFAOYSA-N aluminium Chemical compound [Al] XAGFODPZIPBFFR-UHFFFAOYSA-N 0.000 description 1
- 229910052782 aluminium Inorganic materials 0.000 description 1
- 230000003064 anti-oxidating effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 239000003063 flame retardant Substances 0.000 description 1
- 238000007667 floating Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000009413 insulation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 230000001012 protector Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
- 230000001052 transient effect Effects 0.000 description 1
- 239000003643 water by type Substances 0.000 description 1
Images
Classifications
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明提供了一种实现多船同步进出闸的船舶航行控制系统,包括多艘船舶、闸室定位模块以及岸基船舶监控系统,闸室定位模块包括4个定位基站,在闸室4角处安装所述4个定位基站;所述岸基船舶监控系统包括通讯服务器和岸基客户端,所述通讯服务器用于实现船舶与岸基客户端之间的数据中转,根据定位基站信息及船舶状态信息,获取船舶经纬度,并向船舶客户端及岸基客户端提供船位服务信息;岸基客户端用于显示船舶的实时状态及位置,实时获取每条船舶状态信息,根据通讯服务器提供的定位服务,在百度地图上显示船舶的位置,根据船舶位置信息获得船舶过闸状态,并实时显示;本发明能对航速进行控制,使得多船能同步进出船闸,提高航行的安全性。
The invention provides a ship navigation control system for realizing the simultaneous entry and exit of multiple ships, including multiple ships, a lock chamber positioning module and a shore-based ship monitoring system. The lock chamber positioning module includes four positioning base stations, which are located at the four corners of the lock chamber. Install the four positioning base stations; the shore-based ship monitoring system includes a communication server and a shore-based client, the communication server is used to realize data transfer between the ship and the shore-based client, according to the positioning base station information and the state of the ship information, obtain the latitude and longitude of the ship, and provide ship position service information to the ship client and shore-based client; the shore-based client is used to display the real-time status and position of the ship, obtain the status information of each ship in real time, and provide positioning services according to the communication server. , the position of the ship is displayed on the Baidu map, the state of the ship passing through the lock is obtained according to the position information of the ship, and displayed in real time; the invention can control the speed of the ship, so that multiple ships can enter and exit the ship lock synchronously, and the safety of navigation is improved.
Description
技术领域technical field
本发明涉及船舶航行技术领域,特别是一种实现多船同步进出闸的船舶航行控制系统。The invention relates to the technical field of ship navigation, in particular to a ship navigation control system for realizing the simultaneous entry and exit of multiple ships.
背景技术Background technique
自2000年以来,三峡-葛洲坝船闸过闸货运量持续快速增长,已远远超过三峡-葛洲坝船闸的设计通过能力。船闸通过能力和过闸需求间的矛盾日益突出,而且随着船舶大型化,闸室内船舶停船位置精确控制操纵难度加大,加剧船闸浮式系船柱实施的损耗。同时,船舶操纵难以及过闸移泊快速性要求,加大了闸室内船舶碰撞闸门的风险。Since 2000, the volume of cargo passing through the Three Gorges-Gezhouba Ship Lock has continued to grow rapidly, far exceeding the designed throughput capacity of the Three Gorges-Gezhouba Ship Lock. The contradiction between the passage capacity of the ship lock and the need to pass through the lock is becoming more and more prominent, and with the increase of the size of the ship, the precise control and manipulation of the ship's parking position in the lock room becomes more difficult, which intensifies the wear and tear of the implementation of the floating bollard of the ship lock. At the same time, the difficulty of ship maneuvering and the rapidity of moving through locks increases the risk of ships colliding with the locks in the lock room.
目前,随着船舶航速自动控制与船舶高精度定位以及航行态势感知技术的发展,实现船闸水域多船航行同步控制以及船舶精确定位控制在技术上具有可行性。三峡-葛洲坝船闸是促进长江经济带持续发展的重要节点之一,其日常运行效率和安全保障能力直接影响长江航运的运行效率。在安全稳定的前提下,为缩短船舶进出闸时间,提高三峡-葛洲坝船闸运行通过能力,迫切需要采用船舶智能航行控制的技术实现三峡-葛洲坝船闸多船自适应航行控制同步进出闸。At present, with the development of ship speed automatic control and ship high-precision positioning and navigation situation awareness technology, it is technically feasible to realize the synchronous control of multi-vessel navigation in lock waters and precise positioning of ships. The Three Gorges-Gezhouba Ship Lock is one of the important nodes to promote the sustainable development of the Yangtze River Economic Belt. Its daily operation efficiency and safety guarantee capability directly affect the operation efficiency of the Yangtze River shipping. Under the premise of safety and stability, in order to shorten the time for ships to enter and exit the lock and improve the running capacity of the Three Gorges-Gezhouba Ship Lock, it is urgent to adopt the technology of ship intelligent navigation control to realize the simultaneous entry and exit of the Three Gorges-Gezhouba Ship Lock with multi-vessel adaptive navigation control.
发明内容SUMMARY OF THE INVENTION
为克服上述问题,本发明的目的是提供一种实现多船同步进出闸的船舶航行控制系统,使得多船能同步进出船闸,提高航行的安全性。In order to overcome the above problems, the purpose of the present invention is to provide a ship navigation control system that realizes simultaneous entry and exit of multiple ships into and out of the lock, so that multiple ships can enter and exit the ship lock synchronously, thereby improving the safety of navigation.
本发明采用以下方案实现:一种实现多船同步进出闸的船舶航行控制系统,包括多艘船舶、闸室定位模块以及岸基船舶监控系统,船舶从船闸入口引航道开始,经过闸室,再到船闸出口引航道,整个过程中多艘船舶间保持设定的距离和速度,来进行多个船舶同步过闸,所述闸室定位模块包括4个定位基站,在闸室4角处安装所述4个定位基站,分别为定位基站1、定位基站2、定位基站3、定位基站4,船舶通过定位标签与定位基站之间数据传输实现定位,即船舶通过第一定位标签、第二定位标签、第三定位标签、第四定位标签来获取整个船舶在闸室内的定位、航速、船首向的船舶信息,以及获得多艘船舶中领航船和跟随船两船的距离;所述岸基船舶监控系统包括通讯服务器和岸基客户端,所述通讯服务器用于实现船舶与岸基客户端之间的数据中转,根据定位基站信息及船舶状态信息,获取船舶经纬度,并向船舶客户端及岸基客户端提供船位服务信息;所述岸基客户端用于显示船舶的实时状态及位置,通过因特网实时与通讯服务器通讯,实时获取每条船舶状态信息,根据通讯服务器提供的定位服务,在百度地图上显示船舶的位置,根据船舶位置信息获得船舶过闸状态,并实时显示;所述船舶航行控制系统是以列队中的单艘船舶为控制对象,根据该船获取到的船舶周围状态信息和船舶状态信息,通过自动操作该船车钟,实现该船对前船距离和速度的控制,在多船同步进出闸控制过程中,列队可分为领航船和跟随船,领航船按照闸区航行设定自身的航行速度,跟随船根据与前船或领航船的相对距离和相对速度,动态调整跟随船航速,保持列队状态前进;在列队中领航船为一艘,跟随船为有若干艘。The present invention adopts the following scheme to realize: a ship navigation control system for realizing multiple ships entering and exiting the lock synchronously, including multiple ships, a lock chamber positioning module and a shore-based ship monitoring system. The ship starts from the approach channel at the entrance of the ship lock, passes through the lock chamber, and then To the approach channel at the exit of the ship lock, multiple ships maintain the set distance and speed during the whole process to carry out multiple ships passing through the lock synchronously. The lock chamber positioning module includes 4 positioning base stations, which are installed at the 4 corners of the lock chamber. The four positioning base stations mentioned above are respectively positioning base station 1, positioning base station 2, positioning base station 3, and positioning base station 4. The ship realizes positioning through data transmission between the positioning tag and the positioning base station, that is, the ship uses the first positioning tag and the second positioning tag. , the third positioning tag, and the fourth positioning tag to obtain the positioning, speed, and heading of the entire ship in the lock chamber, and obtain the distance between the leading ship and the following ship among multiple ships; the shore-based ship monitoring The system includes a communication server and a shore-based client, the communication server is used to realize data transfer between the ship and the shore-based client, obtain the longitude and latitude of the ship according to the positioning base station information and the ship state information, and send the information to the ship client and the shore-based client. The client provides ship position service information; the shore-based client is used to display the real-time status and position of the ship, communicate with the communication server in real time through the Internet, and obtain the status information of each ship in real time. The position of the ship is displayed on the board, and the status of the ship passing through the lock is obtained according to the position information of the ship, and displayed in real time; the ship navigation control system takes a single ship in the queue as the control object, and according to the ship's surrounding status information and the ship obtained by the ship Status information, through the automatic operation of the ship clock, the ship can control the distance and speed of the preceding ship. During the multi-ship synchronous entry and exit control process, the queue can be divided into pilot ships and follower ships. Set its own sailing speed, the following ship dynamically adjusts the speed of the following ship according to the relative distance and relative speed to the preceding ship or the leading ship, and maintains the state of platooning; in the queue, there is one leading ship and several following ships.
进一步的,所述船舶包括:工控机、第一定位标签、第二定位标签、第三定位标签、第四定位标签、CAN口转RS232设备、CAN口转以太网口设备、4G路由器、4G雷达、多个RS485转RS232模块、多个舵机电位器模块、手动/自动切换开关、第一短距离毫米波雷达、第二短距离毫米波雷达、第三短距离毫米波雷达、长距离毫米波雷达、脉冲计数器、电罗经以及电源模块;所述第一短距离毫米波雷达、第二短距离毫米波雷达、第三短距离毫米波雷达、长距离毫米波雷达均经过所述CAN口转以太网口设备与所述工控机连接;所述4G路由器、4G雷达均与所述工控机连接,所述第一定位标签、第二定位标签、第三定位标签、第四定位标签均经过所述CAN口转RS232设备与所述工控机连接,所述舵机电位器模块经过所述RS485转RS232模块与所述工控机连接,所述电罗经经过所述RS485转RS232模块与所述工控机连接,所述脉冲计数器经过所述RS485转RS232模块与所述工控机连接,所述手动/自动切换开关与两个舵机电位器模块连接。Further, the ship includes: industrial computer, first positioning label, second positioning label, third positioning label, fourth positioning label, CAN port to RS232 equipment, CAN port to Ethernet port equipment, 4G router, 4G radar , multiple RS485 to RS232 modules, multiple servo potentiometer modules, manual/automatic switch, the first short-range millimeter-wave radar, the second short-range millimeter-wave radar, the third short-range millimeter-wave radar, and the long-range millimeter wave Radar, pulse counter, gyro, and power supply module; the first short-range millimeter-wave radar, the second short-range millimeter-wave radar, the third short-range millimeter-wave radar, and the long-range millimeter-wave radar pass through the CAN port to Ethernet The network port device is connected to the industrial computer; the 4G router and the 4G radar are all connected to the industrial computer, and the first positioning label, the second positioning label, the third positioning label, and the fourth positioning label all pass through the The CAN port to RS232 device is connected to the industrial computer, the steering gear potentiometer module is connected to the industrial computer through the RS485 to RS232 module, and the gyro is connected to the industrial computer through the RS485 to RS232 module. , the pulse counter is connected to the industrial computer through the RS485 to RS232 module, and the manual/automatic switch is connected to two steering gear potentiometer modules.
进一步的,所述工控机采用ARK3510L型号的嵌入式工控机;所述舵机电位器模块型号为SM30BL舵机电位器模块;所述脉冲计数器型号为IPAM-7404脉冲计数器。Further, the industrial computer adopts ARK3510L embedded industrial computer; the steering gear potentiometer module model is SM30BL steering gear potentiometer module; the pulse counter model is IPAM-7404 pulse counter.
进一步的,所述第一短距离毫米波雷达、第二短距离毫米波雷达、第三短距离毫米波雷达的型号均为CAR28F毫米波雷达;所述长距离毫米波雷达型号为:ARS408毫米波雷达。Further, the models of the first short-range millimeter-wave radar, the second short-range millimeter-wave radar, and the third short-range millimeter-wave radar are all CAR28F millimeter-wave radars; the long-range millimeter-wave radar model is: ARS408 millimeter-wave radar radar.
进一步的,所述电源模块包括船舶24v直流电源和24V直流转12V直流稳压电源,所述24V直流转12V直流稳压电源与所述船舶24v直流电源连接,所述24V直流转12V直流稳压电源为船舶航行控制系统提供电源。Further, the power module includes a ship's 24V DC power supply and a 24V DC to 12V DC regulated power supply, the 24V DC to 12V DC regulated power supply is connected to the ship's 24V DC power supply, and the 24V DC to 12V DC regulated power supply is connected. The power supply provides power for the ship's navigation control system.
进一步的,所述领航船是按照航行方式控制本船的航行速度和使船舶停靠在指定位置;速度控制时领航船在引航道和闸室内根据获取到的本船航速,操控船舶车钟,使本船速度维持在设置范围内航行。Further, the pilot ship controls the sailing speed of the ship according to the sailing mode and makes the ship stop at the designated position; during the speed control, the pilot ship controls the ship's clock in the approach channel and the lock room according to the obtained speed of the ship to make the ship's speed. Maintain sailing within the set range.
进一步的,所述船舶通过定位标签与定位基站之间数据传输实现定位具体为:通过定位基站1、定位基站2、定位基站3、定位基站4的四个定位基站构建一个坐标系,第一定位标签、第二定位标签、第三定位标签、第四定位标签就反映为坐标系上的一点,即四个定位标签得到四个坐标位置,取四个定位标签的中心位置定义为船舶现处坐标位置;经过T时间后船舶移动到下一个坐标位置,得到两个不同时间点下的坐标位置,推出船舶移动距离,根据速度公式V=S/T可得到船舶的行驶速度。Further, the positioning of the ship through data transmission between the positioning tag and the positioning base station is specifically: constructing a coordinate system through four positioning base stations of positioning base station 1, positioning base station 2, positioning base station 3, and positioning base station 4, the first positioning The label, the second positioning label, the third positioning label, and the fourth positioning label are reflected as a point on the coordinate system, that is, the four positioning labels get four coordinate positions, and the center position of the four positioning labels is defined as the current coordinate of the ship position; after T time, the ship moves to the next coordinate position, obtains the coordinate positions at two different time points, and deduces the moving distance of the ship. According to the speed formula V=S/T, the speed of the ship can be obtained.
进一步的,所述船舶状态信息包括航行态势信息、船舶速度信息、船舶位置信息、以及船舶航向信息;所述船舶周围状态信息包括:前船位置、前船速度、前船航向、本船的位置、本船的速度、本船的航向、以及障碍物位置信息。Further, the ship state information includes navigation situation information, ship speed information, ship position information, and ship heading information; the ship surrounding state information includes: the position of the previous ship, the speed of the previous ship, the heading of the previous ship, the position of the own ship, Information on own ship's speed, own ship's course, and obstacle positions.
进一步的,所述通讯服务器安装有数据转发模块和网络链接维护模块;所述数据转发模块作为数据传输中转站,转发客户端和船舶之间的数据,具体为:接收来自船舶上报的状态信息、心跳信息;接收来岸基自客户端上报的心跳信息;接收来自船舶上传的雷达图像数据;向所有岸基客户端转发船舶状态信息;向所有岸基客户端转发船用雷达图像数据;所述网络链接维护模块用于判断船舶及岸基客户端链接是否正常,三分钟未收到岸基客户端或船舶上报的心跳信息,主动断开该链接。Further, the communication server is provided with a data forwarding module and a network link maintenance module; the data forwarding module is used as a data transmission transfer station to forward data between the client and the ship, specifically: receiving the status information reported from the ship, Heartbeat information; receive the heartbeat information reported by the client from the shore base; receive the radar image data uploaded from the ship; forward the ship status information to all shore-based clients; forward the marine radar image data to all shore-based clients; the network The link maintenance module is used to judge whether the link between the ship and the shore-based client is normal. If the heartbeat information reported by the shore-based client or the vessel is not received within three minutes, the link will be disconnected actively.
进一步的,所述岸基客户端安装有数据交互模块、地图显示模块和逻辑处理模块;Further, the shore-based client is installed with a data interaction module, a map display module and a logic processing module;
所述数据交互模块采用TCP/IP方式与服务器进行通讯,具体为:接收来自通讯服务器转发的船舶状态信息,接收来自通讯服务器转发的雷达出现信息,接收来自通讯服务器提供的船舶位置服务信息,接收来通讯自服务器的心跳应答;另外以30s周期,向通讯服务器发送心跳包;The data interaction module communicates with the server in a TCP/IP manner, specifically: receiving the ship state information forwarded from the communication server, receiving the radar appearance information forwarded from the communication server, receiving the ship location service information provided by the communication server, receiving The heartbeat response from the communication server; in addition, the heartbeat packet is sent to the communication server at a cycle of 30s;
所述地图显示模块采用百度地图,实现以下功能:地图显示功能:显示地理信息,提供放大、缩小、漫游、归中功能;地图标注功能:在地图上显示船舶当前位置、等待区、过闸区;The map display module adopts Baidu map to realize the following functions: map display function: display geographic information, provide zoom-in, zoom-out, roaming, and return functions; map labeling function: display the current position of the ship, the waiting area, and the gate area on the map ;
所述逻辑处理模块用于:岸基客户端一开始运行后,立即请求连接通讯服务器:The logic processing module is used to request the connection to the communication server immediately after the shore-based client starts running:
(a)若连接通讯服务器成功,立即发送心跳包;之后以30s间隔,向通讯服务器发送心跳包;(a) If the connection to the communication server is successful, the heartbeat packet is sent immediately; after that, the heartbeat packet is sent to the communication server at an interval of 30s;
(b)若连接通讯服务器失败,则间隔15秒重新请求连接;(b) If the connection to the communication server fails, the connection will be re-requested every 15 seconds;
(c)通讯服务器连接成功后,若出现连接断开事件,立即重连;(c) After the communication server is successfully connected, if there is a disconnection event, reconnect immediately;
(d)若3分钟未收到通讯服务器心跳应答,则认为通讯服务器已经断开,立即断开当前连接,重新连接服务器;(d) If the heartbeat response of the communication server is not received within 3 minutes, it is considered that the communication server has been disconnected, the current connection is immediately disconnected, and the server is reconnected;
2.船位显示功能:2. Ship position display function:
根据通讯服务器提供的船位服务信息、船舶上报的实时状态信息,在地图上显示各船的相对位置。According to the ship position service information provided by the communication server and the real-time status information reported by the ship, the relative position of each ship is displayed on the map.
3.过闸状态功能:3. Over-brake state function:
根据船舶的经纬度信息,计算船舶的过闸状态,并在界面中显示。According to the longitude and latitude information of the ship, the state of the ship passing through the lock is calculated and displayed on the interface.
本发明的有益效果在于:本发明包括多艘船舶、闸室定位模块以及岸基船舶监控系统,其中对船舶改造可船航标,通过对多船同步进出船闸航行自动控制技术深入研究,形成船舶同步进出船闸航行自适应控制、闸区船舶动态实时监控、多船同步进出船闸航行方式、闸区船舶防碰撞与精确定位等技术成果,实现该船对前船距离和速度的精确控制,从而使得多船能同步进出船闸,提高航行的安全性。The beneficial effects of the present invention are: the present invention includes a plurality of ships, a lock chamber positioning module and a shore-based ship monitoring system, wherein the ship can be transformed into a navigation mark, and the ship synchronization is formed by in-depth research on the automatic control technology of multi-ship synchronous entry and exit of the ship lock. Technological achievements such as adaptive control of navigation in and out of the lock, real-time monitoring of ship dynamics in the lock area, multi-vessel synchronous navigation in and out of the lock, anti-collision and precise positioning of ships in the lock area, etc. The ship can enter and exit the lock synchronously to improve the safety of navigation.
附图说明Description of drawings
图1是本发明的船舶列队状态示意图。FIG. 1 is a schematic diagram of the state of the ships lining up according to the present invention.
图2是本发明的船舶涉及电路结构示意图。FIG. 2 is a schematic diagram of the circuit structure involved in the ship of the present invention.
图3是本发明的船舶涉及电路使用状态结构示意图。FIG. 3 is a schematic diagram of the structure of the ship related circuit in use state of the present invention.
图4是本发明的领航船控制流程示意图。FIG. 4 is a schematic diagram of the control flow of the pilot ship of the present invention.
图5是本发明的跟随船控制流程示意图。FIG. 5 is a schematic diagram of the control flow of the following ship according to the present invention.
图6是本发明的前船、后船位置关系示意图。FIG. 6 is a schematic diagram of the positional relationship between the front ship and the rear ship of the present invention.
图7是本发明的4个定位基站和8个定位标签安装示意图。FIG. 7 is a schematic diagram of the installation of 4 positioning base stations and 8 positioning labels according to the present invention.
具体实施方式Detailed ways
下面结合附图对本发明做进一步说明。The present invention will be further described below with reference to the accompanying drawings.
请参阅图1至图7所示,本发明提供了一种实现多船同步进出闸的船舶航行控制系统,包括多艘船舶、闸室定位模块以及岸基船舶监控系统,船舶从船闸入口引航道开始,经过闸室,再到船闸出口引航道,整个过程中多艘船舶间保持设定的距离和速度,来进行多个船舶同步过闸,所述闸室定位模块包括4个定位基站,在闸室4角处安装所述4个定位基站,分别为定位基站1、定位基站2、定位基站3、定位基站4,船舶通过定位标签与定位基站之间数据传输实现定位,即船舶通过第一定位标签、第二定位标签、第三定位标签、第四定位标签来获取整个船舶在闸室内的定位、航速、船首向的船舶信息,以及获得多艘船舶中领航船和跟随船两船的距离;所述岸基船舶监控系统包括通讯服务器和岸基客户端,所述通讯服务器用于实现船舶与岸基客户端之间的数据中转,根据定位基站信息及船舶状态信息,获取船舶经纬度,并向船舶客户端及岸基客户端提供船位服务信息;所述岸基客户端用于显示船舶的实时状态及位置,通过因特网实时与通讯服务器通讯,实时获取每条船舶状态信息,根据通讯服务器提供的定位服务,在百度地图上显示船舶的位置,根据船舶位置信息获得船舶过闸状态,并实时显示;所述船舶航行控制系统是以列队中的单艘船舶为控制对象,根据该船获取到的船舶周围状态信息和船舶状态信息,通过自动操作该船车钟,实现该船对前船距离和速度的控制,在多船同步进出闸控制过程中,列队可分为领航船和跟随船,领航船按照闸区航行设定自身的航行速度,跟随船根据与前船或领航船的相对距离和相对速度,动态调整跟随船航速,保持列队状态前进;在列队中领航船为一艘,跟随船为有若干艘,如图1所示。Please refer to FIGS. 1 to 7 , the present invention provides a ship navigation control system for realizing multiple ships entering and exiting the lock synchronously, including multiple ships, a lock chamber positioning module and a shore-based ship monitoring system. At the beginning, through the lock chamber, and then to the approach channel at the exit of the ship lock, multiple ships maintain the set distance and speed during the whole process to carry out multiple ships synchronously passing through the lock. The lock chamber positioning module includes 4 positioning base stations. The four positioning base stations are installed at the four corners of the lock room, namely positioning base station 1, positioning base station 2, positioning base station 3, and positioning base station 4. The ship realizes positioning through data transmission between the positioning tag and the positioning base station, that is, the ship passes the first The positioning tag, the second positioning tag, the third positioning tag, and the fourth positioning tag are used to obtain the ship information of the positioning, speed, and heading of the entire ship in the lock chamber, and obtain the distance between the leading ship and the following ship among multiple ships ; The shore-based ship monitoring system includes a communication server and a shore-based client, the communication server is used to realize data transfer between the ship and the shore-based client, obtain the longitude and latitude of the ship according to the positioning base station information and the ship status information, and Provide ship position service information to the ship client and shore-based client; the shore-based client is used to display the real-time status and position of the ship, communicate with the communication server in real time through the Internet, obtain the status information of each ship in real time, and provide information according to the communication server. The positioning service of the ship shows the position of the ship on the Baidu map, obtains the status of the ship passing through the lock according to the position information of the ship, and displays it in real time; the ship navigation control system takes the single ship in the queue as the control object, and obtains the status of the ship according to the ship's position information. The ship's surrounding state information and ship state information are obtained, and the ship's distance and speed of the preceding ship can be controlled by automatically operating the ship's clock. The leading ship sets its own sailing speed according to the navigation in the lock area, and the following ship dynamically adjusts the speed of the following ship according to the relative distance and relative speed to the preceding ship or the leading ship, and keeps the platooning state; There are several ships, as shown in Figure 1.
其中,参阅图2和图3所示,所述船舶包括工控机1、第一定位标签21、第二定位标签22、第三定位标签23、第四定位标签24、CAN口转RS232设备3、CAN口转以太网口设备4、4G路由器5、4G雷达6、多个RS485转RS232模块7、多个舵机电位器模块8、手动/自动切换开关9、第一短距离毫米波雷达10、第二短距离毫米波雷达11、第三短距离毫米波雷达12、长距离毫米波雷达13、脉冲计数器14、电罗经15以及电源模块16;所述第一短距离毫米波雷达10、第二短距离毫米波雷达11、第三短距离毫米波雷达12、长距离毫米波雷达13均经过所述CAN口转以太网口设备4与所述工控机1连接;所述4G路由器5、4G雷达6均与所述工控机1连接,所述第一定位标签21、第二定位标签22、第三定位标签23、第四定位标签24均经过所述CAN口转RS232设备3与所述工控机1连接,所述舵机电位器8模块经过所述RS485转RS232模块7与所述工控机1连接,所述电罗经15经过所述RS485转RS232模块7与所述工控机1连接,所述脉冲计数器14经过所述RS485转RS232模块7与所述工控机1连接,所述手动/自动切换开关9与两个舵机电位器模块8连接。其中,所述工控机采用ARK3510L型号的嵌入式工控机。2 and 3, the ship includes an industrial computer 1, a first positioning label 21, a second positioning label 22, a third positioning label 23, a fourth positioning label 24, a CAN port to RS232 device 3, CAN port to Ethernet port device 4, 4G router 5, 4G radar 6, multiple RS485 to RS232 modules 7, multiple servo potentiometer modules 8, manual/automatic switch 9, the first short-range millimeter wave radar 10, The second short-range millimeter-wave radar 11, the third short-range millimeter-wave radar 12, the long-range millimeter-wave radar 13, the pulse counter 14, the gyro 15 and the power supply module 16; the first short-range millimeter-wave radar 10, the second The short-range millimeter-wave radar 11, the third short-range millimeter-wave radar 12, and the long-range millimeter-wave radar 13 are all connected to the industrial computer 1 through the CAN port to Ethernet port device 4; the 4G router 5, the 4G radar 6 are all connected to the industrial computer 1, and the first positioning label 21, the second positioning label 22, the third positioning label 23, and the fourth positioning label 24 all pass through the CAN port to the RS232 device 3 and the industrial computer. 1 connection, the steering gear potentiometer 8 module is connected to the industrial computer 1 through the RS485 to RS232 module 7, and the gyro 15 is connected to the industrial computer 1 through the RS485 to RS232 module 7, the said The pulse counter 14 is connected to the industrial computer 1 through the RS485 to RS232 module 7 , and the manual/automatic switch 9 is connected to the two steering gear potentiometer modules 8 . Among them, the said industrial computer adopts ARK3510L embedded industrial computer.
在本发明中,所述第一短距离毫米波雷达、第二短距离毫米波雷达、第三短距离毫米波雷达的型号均为CAR28F毫米波雷达;所述长距离毫米波雷达型号为:ARS408毫米波雷达。第一定位标签21、第二定位标签22、第三定位标签23、第四定位标签24均采用超宽带UWB定位标签,该定位标签集成了三轴陀螺仪与三轴加速度计。In the present invention, the models of the first short-range millimeter-wave radar, the second short-range millimeter-wave radar, and the third short-range millimeter-wave radar are all CAR28F millimeter-wave radars; the long-range millimeter-wave radar model is: ARS408 Millimeter wave radar. The first positioning tag 21 , the second positioning tag 22 , the third positioning tag 23 , and the fourth positioning tag 24 all use ultra-wideband UWB positioning tags, which integrate a three-axis gyroscope and a three-axis accelerometer.
所述舵机电位器模块8型号为SM30BL舵机电位器模块。所述脉冲计数器型号为IPAM-7404脉冲计数器。电罗经15型号为AH-200电罗经;所述CAN口转RS232设备3型号为UT-2506;CAN口转以太网口设备4型号为CNET400;4G雷达6采用FMCW固态雷达、多个RS485转RS232模块7型号为UT-204E;手动/自动切换开关9采用LW26转换开关。The model of the steering gear potentiometer module 8 is SM30BL steering gear potentiometer module. The pulse counter model is IPAM-7404 pulse counter. The model of gyro 15 is AH-200 gyro; the model of CAN port to RS232 device 3 is UT-2506; the model of CAN port to Ethernet port device 4 is CNET400; 4G radar 6 adopts FMCW solid-state radar, multiple RS485 to RS232 The model of module 7 is UT-204E; the manual/automatic switch 9 adopts LW26 switch.
所述电源模块16包括船舶24v直流电源161和24V直流转12V直流稳压电源162,所述24V直流转12V直流稳压电源与所述船舶24v直流电源连接,所述24V直流转12V直流稳压电源为船舶航行控制系统提供电源。The
长距离毫米波雷达ARS408-21是一个77GHz雷达传感器与数字波束形成扫描天线,提供两个独立的扫描仪来扫描远近距离。能同时检测多个相对速度为-400~200公里/小时范围内、距离在250米以内的静止和运动的物体。The long-range millimeter-wave radar ARS408-21 is a 77GHz radar sensor with a digital beamforming scanning antenna that provides two independent scanners to scan far and near distances. It can simultaneously detect multiple stationary and moving objects with a relative speed of -400 to 200 km/h and a distance of less than 250 meters.
距离毫米波雷达CAR28F是一款性价比非常高的短距K波段毫米波雷达传感器系统,监测距离30米,采用FMCW调制模式,能检测运动目标的距离、速度、角度,具有较高的测距与测速精度。Distance millimeter-wave radar CAR28F is a very cost-effective short-range K-band millimeter-wave radar sensor system, with a monitoring distance of 30 meters, using FMCW modulation mode, can detect the distance, speed, and angle of moving targets, with high ranging and Speed measurement accuracy.
定位标签采用超宽带UWB定位标签,集成了三轴陀螺仪与三轴加速度计,通过智能融合算法,能更好的抵抗遮挡、多径效应对定位的影响,让定位更加精准。The positioning tag adopts ultra-wideband UWB positioning tag, which integrates three-axis gyroscope and three-axis accelerometer. Through intelligent fusion algorithm, it can better resist the influence of occlusion and multipath effect on positioning, and make positioning more accurate.
主要特点:main feature:
·自动组网,即插即用·Automatic networking, plug and play
·支持节点动态加入·Support node dynamic join
·支持多标签多基站同时工作Support multi-tag and multi-base stations to work at the same time
·融入高性能IMU,使得定位效果更好Integrate high-performance IMU to make the positioning effect better
·智能组网算法,系统工作稳定。·Intelligent networking algorithm, the system works stably.
电罗经AH-200采用高质量和可靠性的MEMS加速度计、陀螺仪和磁力计,并通过算法保证测量精度,同时密封设计以及严格工艺保证产品在恶劣的环境下仍能精密地测量载体的角速度、加速度和姿态等运动参数。通过非线性补偿、正交补偿、温度补偿和漂移补偿等多种补偿,可以大大消除AH-200的误差源,提高产品精度水平。The gyro compass AH-200 adopts high-quality and reliable MEMS accelerometers, gyroscopes and magnetometers, and ensures the measurement accuracy through algorithms. At the same time, the sealed design and strict process ensure that the product can still accurately measure the angular velocity of the carrier in harsh environments. , acceleration and attitude and other motion parameters. Through various compensations such as nonlinear compensation, quadrature compensation, temperature compensation and drift compensation, the error source of AH-200 can be greatly eliminated and the level of product accuracy can be improved.
工控机采用ARK3510L型号的嵌入式工控机本方案工控机采用研华工控提供的ARK350L第三代CoreTM i7,2x 2.5"可插拔HDD硬盘无风扇嵌入式工控机。The industrial computer adopts the ARK3510L embedded industrial computer. The industrial computer in this solution adopts the third generation ARK350L provided by Advantech Industrial Control. Core TM i7, 2x 2.5" pluggable HDD hard drive fanless embedded industrial computer.
主要特点:main feature:
·支持CoreTM i7-3610QE移动系列处理器(rPGA)+Intel QM77芯片组;·support Core TM i7-3610QE mobile series processor (rPGA) + Intel QM77 chipset;
·i7-3610QE 4核/2.3Ghz;i7-3610QE 4 cores/2.3Ghz;
·第三代Core I处理器支持独立三显:DVI+HDMI+DisplayPort;The third-generation Core I processor supports three independent displays: DVI+HDMI+DisplayPort;
·内存支持DDR3/DDR3L SO-DIMM,最高达16GB;The memory supports DDR3/DDR3L SO-DIMM, up to 16GB;
·支持2x 2.5"removable SATAIII硬盘;·Support 2x 2.5"removable SATAIII hard drives;
·2x miniPCIe卡槽,带SIM卡槽位;2x miniPCIe card slot, with SIM card slot;
·丰富I/O接口,包含4x USB 3.0和4x COM,2个1000M网口;· Rich I/O interfaces, including 4x USB 3.0 and 4x COM, and 2 1000M Ethernet ports;
·锁固式9~34V直流电源输入接口,最大功耗60W。·Locking 9~34V DC power input interface, the maximum power consumption is 60W.
4G路由器选用工业级4G路由器用于连接外网,同时作为工控机与雷达的数据传输通道。4G routers use industrial-grade 4G routers to connect to the external network and serve as the data transmission channel between the industrial computer and the radar.
CAN口转以太网口设备型号为CNET400可实现将标准的CAN总线数据报文格式与标准的TCP/IP数据报文格式,标准的Socket通信指令相互转换。The CAN port to Ethernet port device model is CNET400, which can realize the conversion between the standard CAN bus data message format, the standard TCP/IP data message format, and the standard Socket communication instructions.
舵机电位器模块:Servo potentiometer module:
舵机电位器模块型号为SM30BL无刷串行总线磁编码智能伺服电机,属于一种集电机、伺服驱动、总线式通讯接口为一体的集成伺服单元,非常适合替代传统舵机,作为微型机器人的关节、轮子、履带驱动,也可用于其他简单位置或步进控制场合。The servo potentiometer module model is SM30BL brushless serial bus magnetic coding intelligent servo motor, which belongs to an integrated servo unit that integrates motor, servo drive and bus communication interface. It is very suitable for replacing traditional servos. Joints, wheels, track drives, and other simple position or stepper control applications.
脉冲计数器:Pulse Counter:
脉冲计数器采用IPAM-7404是具有技术,测频功能的数据采集模块,具有4路的技术/测频通道,包括2路隔离输入和2路非隔离输入通道;模块还具有4路的DI通道,可配置成计数/测频通道的门控输入信号;模块还具有4路非隔离DO通道,可配置为匹配或超限报警输出功能。The pulse counter adopts IPAM-7404, which is a data acquisition module with technology and frequency measurement functions. It has 4 technology/frequency measurement channels, including 2 isolated input and 2 non-isolated input channels; the module also has 4 DI channels, It can be configured as gate control input signal of counting/frequency measurement channel; the module also has 4 non-isolated DO channels, which can be configured as matching or over-limit alarm output function.
供电电压:DC 10-30V,电源反接保护;功耗:1W@24VDC。Power supply voltage: DC 10-30V, power reverse connection protection; power consumption: 1W@24VDC.
RS485转RS232模块:RS485 to RS232 module:
RS485转RS232模块采用UT-204转换器兼容RS-232、RS485标准,能够将单端的RS-232信号转换为平衡差分的RS-485信号,内置快速的瞬态电压抑制保护器,内部带有零延时自动收发转换、I/O电路自动控制数据流方向,不需要其它握手信号,可以实现主控机之间、主控机与单片机或外设之间构成点到点,点到多远程通信网络,实现多机应答通信。The RS485 to RS232 module adopts UT-204 converter, which is compatible with RS-232 and RS485 standards. It can convert single-ended RS-232 signals into balanced differential RS-485 signals. It has a built-in fast transient voltage suppression protector and a built-in zero Delay automatic sending and receiving conversion, I/O circuit automatically controls the direction of data flow, no other handshake signals are required, and point-to-point, point-to-multiple remote communication can be realized between the main control machine, between the main control machine and the microcontroller or peripherals network to realize multi-machine response communication.
手动/自动切换开关:Manual/Automatic toggle switch:
该手动/自动切换开关采用LW26转换开关具有电阻率低,导电性能好,抗氧化等特点,并采用阻燃外壳安全性能高,同时具备多个转换角度;其额定绝缘电压690V,额定工作电压AC440V,额定频率50HZ。The manual/automatic transfer switch adopts LW26 transfer switch, which has the characteristics of low resistivity, good electrical conductivity, anti-oxidation, etc., and uses a flame-retardant shell with high safety performance and multiple conversion angles; its rated insulation voltage is 690V, and rated working voltage is AC440V. , Rated frequency 50HZ.
电源模块:Power Module:
电源模块外壳材质为铝制,体积74*74*32MM,重量为260克。模块性能为非隔离BUCK,输出电流为1A至100A,本项目选取30A输出电流。The shell of the power module is made of aluminum, with a volume of 74*74*32MM and a weight of 260 grams. The module performance is non-isolated buck, and the output current is 1A to 100A. This project selects 30A output current.
如图4和图5所示,多船同步进出闸一个很重要的参数就是跟踪船舶与目标船舶的跟踪距离。距离的设定既需要考虑过闸高效率的要求,也需要考虑距离过近带来的安全风险。因此,本发明拟设定动态跟踪距离,即根据船舶不同的操纵性和航行速度来动态调整跟踪距离d。As shown in Figure 4 and Figure 5, a very important parameter for the simultaneous entry and exit of multiple ships is the tracking distance between the tracking ship and the target ship. The setting of the distance needs to consider not only the requirements of high efficiency of the gate, but also the safety risks brought by the distance too close. Therefore, the present invention intends to set a dynamic tracking distance, that is, to dynamically adjust the tracking distance d according to the different maneuverability and sailing speed of the ship.
d=αL+βV (3.1)d=αL+βV (3.1)
其中,L表示船长,通常船长越大,船舶操纵性也越差;V表示前船航行速度;α和β为参数值。Among them, L represents the length of the ship. Usually, the larger the length of the ship, the worse the ship's maneuverability; V represents the speed of the preceding ship; α and β are parameter values.
所述领航船是按照航行方式控制本船的航行速度和使船舶停靠在指定位置;速度控制时领航船在引航道和闸室内根据获取到的本船航速,操控船舶车钟,使本船速度维持在设置范围内航行。The pilot ship controls the speed of the ship according to the sailing method and makes the ship stop at the designated position; when the speed is controlled, the pilot ship controls the ship's clock in the approach channel and the lock room according to the speed of the ship obtained, so that the speed of the ship is maintained at the setting. sailing within range.
如图6所示,每一艘跟随船都有一条目标船,目标船能为其他跟随或者领航船;跟随船根据目标船的速度、距离,控制本船与目标船的相对距离和速度,同时闸室内前船和后船在过闸时的位置必须存在如下关系:设置ABDC表示前船,EFHG表示本船,IJLK表示后船;本船EFHG在前、左、右、后位置安装的毫米波雷达获取的正前方距离分别为d1、d2、d3和d4;本船相对于闸室前进方向的夹角为ψ,则参数计算如下:As shown in Figure 6, each follower ship has a target ship, and the target ship can be other follower or pilot ships; the follower ship controls the relative distance and speed of the own ship and the target ship according to the speed and distance of the target ship, and locks at the same time. The position of the indoor front ship and the rear ship when passing through the lock must have the following relationship: set ABDC to represent the front ship, EFHG to represent the own ship, and IJLK to represent the rear ship; the EFHG of this ship is obtained by the millimeter-wave radar installed in the front, left, right and rear positions. The distances directly ahead are d 1 , d 2 , d 3 and d 4 respectively; the included angle of the ship relative to the forward direction of the lock chamber is ψ, the parameters are calculated as follows:
式中,W、L分别为本船的宽度和长度;where W and L are the width and length of the ship, respectively;
采用模糊PID作为自适应巡航控制方式,则自适应巡航控制方式以前船与本船距离作为输入,以本船车钟指令作为输出,跟踪目标距离设定为d0,t时刻两船的实际距离为d(t),t时刻本船的车钟指令为u(t);Using fuzzy PID as the adaptive cruise control mode, the adaptive cruise control mode takes the distance between the previous ship and own ship as the input, and the own ship's clock command as the output, the tracking target distance is set as d 0 , and the actual distance between the two ships at time t is d (t), the clock command of the ship at time t is u(t);
其中,KP、KI和KD表示PID参数,考虑到相同转速下的船舶螺旋桨正转与反转效率不同,因此需要针对正车和倒车分别设置PID参数;Among them, K P , K I and K D represent the PID parameters. Considering the difference in the forward and reverse efficiency of the ship propeller at the same speed, it is necessary to set the PID parameters for forward and reverse respectively;
假定t时刻两船相对速度为Vd(t),Vd(t)<0表示两船距离在缩短,为保持船舶跟踪的稳定性,设定跟踪目标距离模糊区为[d0-D,d0+D],在模糊区范围的u(t)为:Assuming that the relative speed of the two ships at time t is V d (t), V d (t) < 0 means that the distance between the two ships is shortening, in order to maintain the stability of the ship tracking, set the tracking target distance fuzzy area as [d 0 -D, d 0 +D], u(t) in the fuzzy area is:
其中,V0为速度阈值,K0表示控制参数,D表示距离设定阈值。Among them, V 0 is the speed threshold, K 0 is the control parameter, and D is the distance setting threshold.
所述领航船是按照航行方式控制本船的航行速度和使船舶停靠在指定位置;速度控制时领航船在引航道和闸室内根据获取到的本船航速,操控船舶车钟,使本船速度维持在设置范围内航行。The pilot ship controls the speed of the ship according to the sailing method and makes the ship stop at the designated position; when the speed is controlled, the pilot ship controls the ship's clock in the approach channel and the lock room according to the speed of the ship obtained, so that the speed of the ship is maintained at the setting. sailing within range.
如图7所示,所述船舶通过定位标签与定位基站之间数据传输实现定位具体为:通过定位基站1、定位基站2、定位基站3、定位基站4的四个定位基站构建一个坐标系,第一定位标签、第二定位标签、第三定位标签、第四定位标签就反映为坐标系上的一点,即四个定位标签得到四个坐标位置,取四个定位标签的中心位置定义为船舶现处坐标位置;经过T时间后船舶移动到下一个坐标位置,得到两个不同时间点下的坐标位置,推出船舶移动距离,根据速度公式V=S/T可得到船舶的行驶速度。As shown in FIG. 7 , the positioning of the ship through data transmission between the positioning tag and the positioning base station is specifically: constructing a coordinate system through four positioning base stations of positioning base station 1, positioning base station 2, positioning base station 3, and positioning base station 4, The first positioning label, the second positioning label, the third positioning label, and the fourth positioning label are reflected as a point on the coordinate system, that is, the four positioning labels obtain four coordinate positions, and the center position of the four positioning labels is defined as the ship. The current coordinate position; after T time, the ship moves to the next coordinate position, and the coordinate positions at two different time points are obtained, and the moving distance of the ship is deduced. According to the speed formula V=S/T, the traveling speed of the ship can be obtained.
另外,所述船舶状态信息包括航行态势信息、船舶速度信息、船舶位置信息、以及船舶航向信息;所述船舶周围状态信息包括:前船位置、前船速度、前船航向、本船的位置、本船的速度、本船的航向、以及障碍物位置信息。In addition, the ship state information includes navigation situation information, ship speed information, ship position information, and ship heading information; the ship surrounding state information includes: the position of the previous ship, the speed of the previous ship, the heading of the previous ship, the position of the ship, the ship's position speed, own ship's course, and obstacle position information.
通讯服务器主要用于实现船舶与岸基客户端之间的数据中转,运行在阿里云ECS服务器,主要功能为:The communication server is mainly used to realize the data transfer between the ship and the shore-based client. It runs on the Alibaba Cloud ECS server. The main functions are:
·通过因特网实时与船舶通讯,支持多条船舶同时在线。·Communicate with ships in real time through the Internet, supporting multiple ships online at the same time.
·通过因特网实时与平板、PC通讯,支持多客户端同时在线。·Communicate with tablet and PC in real time through the Internet, and support multiple clients online at the same time.
·实现船舶与岸基客户端之间数据透传。·Realize data transparent transmission between ships and shore-based clients.
·根据定位基站信息及船舶状态信息,计算船舶经纬度,并向船舶客户端及岸基客户端提供船位服务信息。·According to the positioning base station information and ship status information, calculate the longitude and latitude of the ship, and provide the ship position service information to the ship client and shore-based client.
所述通讯服务器安装有数据转发模块和网络链接维护模块;所述数据转发模块作为数据传输中转站,转发客户端和船舶之间的数据,具体为:接收来自船舶上报的状态信息、心跳信息;接收来岸基自客户端上报的心跳信息;接收来自船舶上传的雷达图像数据;向所有岸基客户端转发船舶状态信息;向所有岸基客户端转发船用雷达图像数据;所述网络链接维护模块用于判断船舶及岸基客户端链接是否正常,三分钟未收到岸基客户端或船舶上报的心跳信息,主动断开该链接。The communication server is provided with a data forwarding module and a network link maintenance module; the data forwarding module is used as a data transmission transfer station to forward data between the client and the ship, specifically: receiving status information and heartbeat information reported from the ship; Receive the heartbeat information reported by the client from the shore base; receive the radar image data uploaded from the ship; forward the ship status information to all shore-based clients; forward the marine radar image data to all shore-based clients; the network link maintenance module It is used to judge whether the link between the ship and the shore-based client is normal. If the heartbeat information reported by the shore-based client or the ship is not received within three minutes, the link will be disconnected actively.
岸基客户端主要用于显示船舶的实时状态及位置,运行在基于windows系统下的平板或PC,主要功能为:The shore-based client is mainly used to display the real-time status and position of the ship. It runs on a tablet or PC based on the windows system. The main functions are:
·通过因特网实时与通讯服务器通讯,实时获取每条船舶状态信息。·Communicate with the communication server in real time through the Internet, and obtain the status information of each ship in real time.
·实时显示每条船舶状态信息。·Real-time display of the status information of each ship.
·根据通讯服务器提供的定位服务,在百度地图上显示船舶的位置。· According to the positioning service provided by the communication server, the position of the ship is displayed on the Baidu map.
·根据船舶位置信息计算船舶过闸状态,并实时显示。·According to the ship's position information, the ship's lock status is calculated and displayed in real time.
·定时显示船用雷达图像。·Regular display of marine radar images.
所述岸基客户端安装有数据交互模块、地图显示模块和逻辑处理模块;The shore-based client is installed with a data interaction module, a map display module and a logic processing module;
所述数据交互模块采用TCP/IP方式与服务器进行通讯,具体为:接收来自通讯服务器转发的船舶状态信息,接收来自通讯服务器转发的雷达出现信息,接收来自通讯服务器提供的船舶位置服务信息,接收来通讯自服务器的心跳应答;另外以30s周期,向通讯服务器发送心跳包;The data interaction module communicates with the server in a TCP/IP manner, specifically: receiving the ship state information forwarded from the communication server, receiving the radar appearance information forwarded from the communication server, receiving the ship location service information provided by the communication server, receiving The heartbeat response from the communication server; in addition, the heartbeat packet is sent to the communication server at a cycle of 30s;
所述地图显示模块采用百度地图,实现以下功能:地图显示功能:显示地理信息,提供放大、缩小、漫游、归中功能;地图标注功能:在地图上显示船舶当前位置、等待区、过闸区;The map display module adopts Baidu map to realize the following functions: map display function: display geographic information, provide zoom-in, zoom-out, roaming, and return functions; map labeling function: display the current position of the ship, the waiting area, and the gate area on the map ;
所述逻辑处理模块用于:岸基客户端一开始运行后,立即请求连接通讯服务器:The logic processing module is used to request the connection to the communication server immediately after the shore-based client starts running:
(a)若连接通讯服务器成功,立即发送心跳包;之后以30s间隔,向通讯服务器发送心跳包;(a) If the connection to the communication server is successful, the heartbeat packet is sent immediately; after that, the heartbeat packet is sent to the communication server at an interval of 30s;
(b)若连接通讯服务器失败,则间隔15秒重新请求连接;(b) If the connection to the communication server fails, the connection will be re-requested every 15 seconds;
(c)通讯服务器连接成功后,若出现连接断开事件,立即重连;(c) After the communication server is successfully connected, if there is a disconnection event, reconnect immediately;
(d)若3分钟未收到通讯服务器心跳应答,则认为通讯服务器已经断开,立即断开当前连接,重新连接服务器;(d) If the heartbeat response of the communication server is not received within 3 minutes, it is considered that the communication server has been disconnected, the current connection is immediately disconnected, and the server is reconnected;
2.船位显示功能:2. Ship position display function:
根据通讯服务器提供的船位服务信息、船舶上报的实时状态信息,在地图上显示各船的相对位置。According to the ship position service information provided by the communication server and the real-time status information reported by the ship, the relative position of each ship is displayed on the map.
3.过闸状态功能:3. Over-brake state function:
根据船舶的经纬度信息,计算船舶的过闸状态,并在界面中显示。According to the longitude and latitude information of the ship, the state of the ship passing through the lock is calculated and displayed on the interface.
总之,本发明将多艘船舶间保持设定的距离和速度,来进行多个船舶同步过闸,所述多船同步进出闸的控制是以列队中的单艘船舶为控制对象,根据该船获取到的船舶周围状态信息和自身状态信息,通过自动操作该船车钟,实现该船对前船距离和速度的控制,在多船同步进出闸控制过程中,列队可分为领航船和跟随船,领航船按照闸区航行设定自身的航行速度,跟随船根据与前船或领航船的相对距离和相对速度,动态调整跟随船航速,保持列队状态前进;实现该船对前船距离和速度的精确控制,从而使得多船能同步进出船闸,提高航行的安全性。In a word, the present invention maintains a set distance and speed between multiple ships, so that multiple ships can pass through the lock synchronously. The obtained state information around the ship and its own state information, through the automatic operation of the ship's car clock, to realize the ship's control of the distance and speed of the preceding ship. The ship and the pilot ship set their own sailing speed according to the navigation in the lock area, and the following ship dynamically adjusts the speed of the following ship according to the relative distance and relative speed to the preceding ship or the leading ship, and maintains the platoon state to move forward; The precise control of speed enables multiple ships to enter and exit the lock synchronously, improving the safety of navigation.
以上所述仅为本发明的较佳实施例,凡依本发明申请专利范围所做的均等变化与修饰,皆应属本发明的涵盖范围。The above descriptions are only preferred embodiments of the present invention, and all equivalent changes and modifications made according to the scope of the patent application of the present invention shall fall within the scope of the present invention.
Claims (10)
- The ship navigation control system is characterized by comprising a plurality of ships, a lock room positioning module and a shore-based ship monitoring system, wherein the ships are guided from an entrance of a lock to a navigation channel, pass through a lock room and then to an exit of the lock to the navigation channel, set distances and speeds are kept among the plurality of ships in the whole process to synchronously pass through the lock, the lock room positioning module comprises 4 positioning base stations, the 4 positioning base stations are installed at 4 corners of the lock room and are respectively a positioning base station 1, a positioning base station 2, a positioning base station 3 and a positioning base station 4, the ships are positioned through data transmission between the positioning labels and the positioning base stations, namely the ships are positioned through a positioning label, a second positioning label, a third positioning label and a fourth positioning label, positioning information of the whole ships in the lock room, navigation speed and ship information of a first direction are obtained, and the distances between the ships and two pilot ships in the lock and the ship follow-based ship navigation state are obtained through a communication server and a client terminal, the client terminal is used for realizing real-time adjustment of the ship navigation information and the navigation information of the ship navigation between the ship and the ship, the ship navigation state of the client, the ship and the client terminal, the client terminal is used for realizing the navigation information of the navigation and displaying the navigation information of the ship in the navigation of the ship, the navigation of the ship, the navigation of the navigation along with the navigation system, the client, the navigation system is used for realizing the navigation system.
- 2. The ship navigation control system for realizing synchronous entry and exit of multiple ships according to claim 1, wherein the ship comprises an industrial personal computer, a positioning tag, a second positioning tag, a third positioning tag, a fourth positioning tag, a CAN port-to-RS 232 device, a CAN port-to-Ethernet port device, a 4G router, a 4G radar, multiple RS 485-to-RS 232 modules, multiple steering engine potentiometer modules, a manual/automatic switching switch, a short-distance millimeter wave radar, a second short-distance millimeter wave radar, a third short-distance millimeter wave radar, a long-distance millimeter wave radar, a pulse counter, an electric compass and a power module, wherein the short-distance millimeter wave radar, the second short-distance millimeter wave radar, the third short-distance millimeter wave radar and the long-distance millimeter wave radar are all connected with the industrial personal computer through the CAN port-to Ethernet port device, the 4G router and the 4G radar are all connected with the industrial personal computer, the positioning tag, the second positioning tag, the third positioning tag and the fourth positioning tag are all connected with the industrial personal computer through the CAN port-to the RS232 device, the steering engine is connected with the RS 485-to the electric compass module, and the steering engine module are connected with the RS 485-to the steering engine RS 485-to the automatic switching switch module.
- 3. The ship navigation control system for realizing synchronous multi-ship entry and exit gate according to claim 2, wherein the industrial personal computer is an embedded industrial personal computer of ARK3510L type, the steering engine potentiometer module is SM30BL steering engine potentiometer module, and the pulse counter is an IPAM-7404 pulse counter.
- 4. The ship navigation control system for realizing the multi-ship synchronous entry and exit gate according to claim 2, wherein the th, second and third short-range millimeter wave radars are CAR28F millimeter wave radars, and the long-range millimeter wave radar is ARS408 millimeter wave radar.
- 5. The ship navigation control system for realizing multi-ship synchronous entry and exit gate of claim 2, wherein the power module comprises a ship 24V DC power supply and a 24V DC-to-12V DC stabilized power supply, the 24V DC-to-12V DC stabilized power supply is connected with the ship 24V DC power supply, and the 24V DC-to-12V DC stabilized power supply provides power for the ship navigation control system.
- 6. The system of for controlling the navigation of ships according to the synchronized entry and exit gates of multiple ships, according to claim 1, wherein the pilot ship controls the navigation speed of the ship and stops the ship at a predetermined position according to the navigation mode, and the speed control is performed by operating the clock of the ship in the navigation channel and lock room according to the obtained navigation speed of the ship to maintain the speed of the ship within a predetermined range.
- 7. The ship navigation control system for realizing multi-ship synchronous entry and exit gate according to claim 1, wherein the positioning of the ship through data transmission between the positioning tags and the positioning base stations is realized by constructing coordinate systems through four positioning base stations of positioning base station 1, positioning base station 2, positioning base station 3, and positioning base station 4, the positioning tag, the second positioning tag, the third positioning tag, and the fourth positioning tag reflect points on the coordinate systems, that is, the four positioning tags obtain four coordinate positions, the central positions of the four positioning tags are defined as the current coordinate positions of the ship, after T time, the ship moves to the lower coordinate positions to obtain the coordinate positions at two different time points, the ship moving distance is derived, and the ship moving speed can be obtained according to the speed formula V-S/T.
- 8. The ship navigation control system for realizing multi-ship synchronous entry and exit lock, according to claim 1, wherein the ship state information includes navigation situation information, ship speed information, ship position information, and ship course information, and the ship surrounding state information includes forward ship position, forward ship speed, forward ship course, own ship position, own ship speed, own ship course, and obstacle position information.
- 9. The ship navigation control system for realizing multi-ship synchronous entry and exit gate of claim 1, wherein the communication server is equipped with a data forwarding module and a network link maintenance module;the data forwarding module is used as a data transmission transfer station for forwarding data between a client and a ship, and specifically comprises the following steps: receiving state information and heartbeat information reported by a ship; receiving heartbeat information reported from a client on a shore basis; receiving radar image data uploaded by a ship; forwarding ship state information to all shore-based clients; forwarding the image data of the marine radar to all shore-based clients;the network link maintenance module is used for judging whether the ship and the shore-based client link are normal or not, not receiving heartbeat information reported by the shore-based client or the ship for three minutes, and actively disconnecting the link.
- 10. The ship navigation control system for realizing multi-ship synchronous entry and exit gate of claim 9, wherein the shore-based client is provided with a data interaction module, a map display module and a logic processing module;the data interaction module communicates with the server in a TCP/IP mode, and specifically comprises the following steps: receiving ship state information forwarded by a communication server, receiving radar occurrence information forwarded by the communication server, receiving ship position service information provided by the communication server, and receiving heartbeat response from the communication server; in addition, sending heartbeat packets to the communication server in a period of 30 s;the map display module adopts a Baidu map to realize the following functions: a map display function: displaying geographic information, and providing functions of zooming in, zooming out, roaming and centering; the map marking function is as follows: displaying the current position, the waiting area and the passing area of the ship on a map;the logic processing module is used for immediately requesting to connect the communication server after the shore-based client starts to operate:(a) if the connection with the communication server is successful, a heartbeat packet is sent immediately; then sending heartbeat packets to a communication server at intervals of 30 s;(b) if the connection with the communication server fails, re-requesting connection at an interval of 15 seconds;(c) after the communication server is successfully connected, if a connection disconnection event occurs, immediately reconnecting;(d) and if the heartbeat response of the communication server is not received within 3 minutes, the communication server is considered to be disconnected, the current connection is immediately disconnected, and the server is reconnected.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911075333.XA CN110737275B (en) | 2019-11-06 | 2019-11-06 | Ship navigation control system for realizing synchronous gate entry and exit of multiple ships |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911075333.XA CN110737275B (en) | 2019-11-06 | 2019-11-06 | Ship navigation control system for realizing synchronous gate entry and exit of multiple ships |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110737275A true CN110737275A (en) | 2020-01-31 |
CN110737275B CN110737275B (en) | 2022-04-15 |
Family
ID=69272292
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911075333.XA Active CN110737275B (en) | 2019-11-06 | 2019-11-06 | Ship navigation control system for realizing synchronous gate entry and exit of multiple ships |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110737275B (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111695198A (en) * | 2020-06-03 | 2020-09-22 | 重庆交通大学 | Automatic sensing and early warning system for stress characteristics of ship lock floating mooring column |
CN112927386A (en) * | 2021-01-21 | 2021-06-08 | 中交第三航务工程局有限公司 | Intelligent management system for ships |
CN119360678A (en) * | 2024-12-23 | 2025-01-24 | 京杭运河江苏省船闸应急保障中心 | Automatic ship lock control system and control method |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090018774A1 (en) * | 2007-07-10 | 2009-01-15 | Winkler Michael F | Real time environmental measurement and reporting system for navigable waterways and method of use |
CN102419913A (en) * | 2011-08-12 | 2012-04-18 | 上海海事大学 | Ship lockage management system based on RFID technology and method thereof |
US20120176222A1 (en) * | 2009-09-09 | 2012-07-12 | Hyundai Heavy Industries Co., Ltd. | Apparatus for managing the operation of a ship block |
CN104077676A (en) * | 2014-06-26 | 2014-10-01 | 王�忠 | Water transport safety real-time dynamic management and control system |
CN104123855A (en) * | 2014-07-18 | 2014-10-29 | 中国长江三峡集团公司 | Safe navigation auxiliary system and method for ship passing ship lock |
CN108519581A (en) * | 2018-03-26 | 2018-09-11 | 武汉丰蓝科技有限公司 | The system and method that ship based on UWB positions in ship lock |
CN109427216A (en) * | 2017-08-27 | 2019-03-05 | 南京乐朋电子科技有限公司 | To lock ship information real-time monitoring system |
-
2019
- 2019-11-06 CN CN201911075333.XA patent/CN110737275B/en active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090018774A1 (en) * | 2007-07-10 | 2009-01-15 | Winkler Michael F | Real time environmental measurement and reporting system for navigable waterways and method of use |
US20120176222A1 (en) * | 2009-09-09 | 2012-07-12 | Hyundai Heavy Industries Co., Ltd. | Apparatus for managing the operation of a ship block |
CN102419913A (en) * | 2011-08-12 | 2012-04-18 | 上海海事大学 | Ship lockage management system based on RFID technology and method thereof |
CN104077676A (en) * | 2014-06-26 | 2014-10-01 | 王�忠 | Water transport safety real-time dynamic management and control system |
CN104123855A (en) * | 2014-07-18 | 2014-10-29 | 中国长江三峡集团公司 | Safe navigation auxiliary system and method for ship passing ship lock |
CN109427216A (en) * | 2017-08-27 | 2019-03-05 | 南京乐朋电子科技有限公司 | To lock ship information real-time monitoring system |
CN108519581A (en) * | 2018-03-26 | 2018-09-11 | 武汉丰蓝科技有限公司 | The system and method that ship based on UWB positions in ship lock |
Non-Patent Citations (8)
Title |
---|
LIU, XL等: "Portable Ship Information Querying System Based on Android", 《2012 11TH INTERNATIONAL SYMPOSIUM ON DISTRIBUTED COMPUTING AND APPLICATIONS TO BUSINESS, ENGINEERING & SCIENCE (DCABES)》 * |
WEIGANG WANG等: "Classification of Ship Trajectories by Using Naive Bayesian algorithm", 《THE 5TH INTERNATIONAL CONFERENCE ON TRANSPORTATION INFORMATION AND SAFETY》 * |
刘轰等: "基于智能手机和RFID的内河航运动态监管与信息服务系统研究", 《计算机测量与控制》 * |
张钊等: "基于RFID的船舶过闸报到系统", 《计算机应用》 * |
王太伟等: "船舶出闸管理仿真平台框架及关键技术研究", 《科技资讯》 * |
王瑞等: "基于AIS的内河船舶过闸管理系统研究", 《中国水运(下半月)》 * |
申霞等: "船闸泄水的非恒定流特性及通航安全措施", 《中国港湾建设》 * |
袁学忠: "江苏内河船舶便捷过闸系统的试点应用", 《中国水运》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111695198A (en) * | 2020-06-03 | 2020-09-22 | 重庆交通大学 | Automatic sensing and early warning system for stress characteristics of ship lock floating mooring column |
CN112927386A (en) * | 2021-01-21 | 2021-06-08 | 中交第三航务工程局有限公司 | Intelligent management system for ships |
CN119360678A (en) * | 2024-12-23 | 2025-01-24 | 京杭运河江苏省船闸应急保障中心 | Automatic ship lock control system and control method |
Also Published As
Publication number | Publication date |
---|---|
CN110737275B (en) | 2022-04-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110737275B (en) | Ship navigation control system for realizing synchronous gate entry and exit of multiple ships | |
CN205193562U (en) | Unmanned aerial vehicle flight control based on ethernet exchange bus | |
CN109799842B (en) | Multi-unmanned aerial vehicle sequence flight control method | |
CN112147999A (en) | Automatic driving experiment AGV vehicle platform | |
CN109425342A (en) | Indoor positioning and following UAV equipment based on UWB technology | |
CN107576328A (en) | A kind of automatic Tracking monitoring system of water surface for submarine navigation device | |
CN109857102B (en) | A wheeled robot formation and tracking control method based on relative position | |
CN108521670A (en) | UWB communication and positioning based method for multi-machine-oriented close formation flight and integrated system | |
WO2020151663A1 (en) | Vehicle positioning apparatus, system and method, and vehicle | |
US12276727B2 (en) | Target following method, device, apparatus and system | |
CN108733078A (en) | A kind of formation control method, the apparatus and system of unmanned systems cluster | |
CN110177337A (en) | Indoor orientation method and indoor positioning shopping cart system | |
CN115826622B (en) | Night co-location method for unmanned aerial vehicle group | |
CN111707988A (en) | Unmanned aerial vehicle positioning system and positioning method based on unmanned vehicle on-board UWB base station | |
CN109914286A (en) | The ad hoc network railway spike induced safely for highway low visibility rain and fog weather | |
CN116225011A (en) | Trajectory adjustment method and device for autonomous mobile equipment | |
Zhou et al. | A UAV patrol system based on Bluetooth localization | |
CN207010858U (en) | A River Pollution Video Acquisition and Transmission System Based on Autonomous Cruising Unmanned Vessel | |
Cao et al. | Uwb based integrated communication and positioning system for multi-uavs close formation | |
Shi et al. | A nano-quadcopter formation flight system based on UWB indoor positioning technology | |
CN214174915U (en) | Navigation control system for wall-climbing robot | |
CN106919168A (en) | It is indoor to test alignment system from model plane maneuverability | |
CN210377160U (en) | Ship navigation control system with synchronous gate access | |
CN209063105U (en) | An indoor service robot system based on UWB positioning | |
CN112207844A (en) | Intelligent guiding robot based on ismart |
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 | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20201130 Address after: 443000 No. 12, Shang Causeway Road, Xiling District, Yichang, Hubei. Applicant after: THREE GORGES NAVIGATION AUTHORITY Applicant after: MINJIANG University Address before: 350120 No. 200 Xiyuan Gong Road, Shangjie Town, Minhou County, Fuzhou City, Fujian Province Applicant before: MINJIANG University |
|
TA01 | Transfer of patent application right | ||
CB03 | Change of inventor or designer information |
Inventor after: Qi Junlin Inventor after: Wu Yong Inventor after: Liu Xinglong Inventor after: Zhao Meng Inventor after: Xu Zhipeng Inventor after: Zheng Fujin Inventor after: Liu Chenguang Inventor after: Hou Guojiao Inventor after: Liu Zhenjia Inventor after: Chu Xiumin Inventor after: Zhou Hongchun Inventor after: Wang Shijian Inventor after: Zhang Bo Inventor after: Li Tao Inventor before: Liu Chenguang Inventor before: Chu Xiumin Inventor before: Li Tao Inventor before: Wu Yong Inventor before: Zheng Fujin Inventor before: Liu Xinglong |
|
CB03 | Change of inventor or designer information | ||
GR01 | Patent grant | ||
GR01 | Patent grant |