Information processing system
Patent Information
- Application Number
- JP2023133296
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-08-18
- Publication Date
- 2025-03-03
- Estimated Expiration
- 2043-08-18
AI Technical Summary
【0007】 本開示によれば、安全に、且つ、効率的に障害物を回避して航行するための情報処理システムを提供することができる。
Smart Images

Figure 2025028464000001_ABST
Abstract
Description
[Technical field]
[0001] The present disclosure relates to an information processing system. [Background technology]
[0002] Conventionally, when a ship navigates, it is necessary to avoid obstacles such as floating objects on the water surface and other ships, and technology to do so is required. For example, Patent Document 1 discloses a system that integrates sensor data from multiple sensors to detect foreign objects present on the ship's travel path and assist the ship in avoiding collisions. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] JP 2019-036010 A Summary of the Invention [Problem to be solved by the invention]
[0004] However, if a ship navigates along a route that is farther away from an obstacle than necessary in order to avoid the obstacle, the ship will have to take a detour, which can lead to poor time and fuel efficiency.
[0005] Therefore, the present disclosure has been made in consideration of the above problems, and has an object to provide an information processing system for safely and efficiently avoiding obstacles and navigating. [Means for solving the problem]
[0006] According to the present disclosure, a control unit that executes information processing for avoiding obstacles and navigating to a destination is provided, An information processing system is provided in which the control unit executes a parameter determination process to determine parameters related to the distance the ship will move away from an obstacle when avoiding the obstacle, based on obstacle information including position information and size information of the obstacle on or underwater. Effect of the Invention
[0007] According to the present disclosure, it is possible to provide an information processing system for safely and efficiently avoiding obstacles while navigating. [Brief description of the drawings]
[0008] [Figure 1] FIG. 1 is a diagram illustrating an information processing system according to an embodiment of the present disclosure. [Diagram 2] FIG. 2 is a diagram showing a ship to which an example of an information processing system according to the embodiment is applied. [Diagram 3] 11 is a flowchart illustrating a series of controls in the information processing system according to the embodiment. FIG. [Figure 4] 11 is a diagram showing an example of an appropriate obstacle avoidance distance according to the embodiment; FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0009] Hereinafter, preferred embodiments of the present disclosure will be described in detail with reference to the accompanying drawings. In this specification and the drawings, components having substantially the same functional configurations are denoted by the same reference numerals, and redundant description will be omitted.
[0010] FIG. 1 is an example of an information processing system (hereinafter, also simply referred to as "system") according to this embodiment. The system of this embodiment can be installed on any type of vessel, and is particularly suitable for relatively small vessels. Specifically, the system of this embodiment can be adopted in fishing boats, water taxis, small multipurpose vessels, pleasure fishing boats, passenger boats, transportation boats, work boats, fireboats / patrol boats, pleasure yachts, pleasure motorboats, special work vessels, etc., and can also be adopted in large passenger ships, tankers, cargo ships, etc.
[0011] The system of this embodiment is equipped with a control unit that performs information processing to avoid obstacles and navigate to a destination, and the control unit performs a parameter determination process to determine parameters related to the distance the ship will move away from an obstacle when avoiding the obstacle, based on obstacle information including position information and size information of the obstacle on or underwater.
[0012] The system of this embodiment is an information processing system 1 for safely and efficiently avoiding obstacles when a ship is navigating. Specifically, by determining a parameter related to the distance to be kept away from an obstacle based on information on the position and size of the obstacle, it is possible to safely avoid the obstacle while preventing a decrease in efficiency by not making an unnecessary detour.
[0013] The system 1 includes, for example, a data acquisition unit 10, a control unit 20, a storage unit 30, an input unit 40, an output unit 50, a communication unit 60, and a vessel operation control unit 70. Each component is connected by wire or wirelessly and can communicate with each other. In this example, the control unit 20, the storage unit 30, the input unit 40, the output unit 50, and the communication unit 60 are implemented in an information processing device (computer), but this is not limited thereto, and each component may be provided independently.
[0014] The data acquisition unit 10 includes a plurality of data acquisition means such as various sensors and cameras, and acquires various sensor data and image data. The data acquisition unit may include, for example, a camera, a radar device such as Lidar (Light detection and ranging), a marine radar, or a millimeter wave radar, an ultrasonic ranging sensor, a GNSS module, or a QZSS module, a positioning device such as an AIS (Automatic Identification System), an inertial measurement unit (IMU), an inertial sensor, a wind direction sensor, a wind speed sensor, a speed sensor (ground speed sensor, water speed sensor), a direction sensor, an acceleration sensor, a gyro sensor, a magnetic compass, a satellite compass, a temperature sensor, a humidity sensor, a pressure sensor, an altitude sensor, an infrared sensor, etc. The data acquisition unit 10 can acquire information on the current position (coordinates), attitude (direction such as bow direction), moving speed, moving direction, and turning amount of the ship, information on the surrounding environment, and information on obstacles such as other ships and people. AIS is a system for transmitting and receiving various information between ships and between ships and land facilities, and can wirelessly exchange ship information such as the position, attitude (course), moving speed, destination, etc. The direction sensor may be a magnetic direction sensor that calculates the bow direction using geomagnetism, a gyrocompass, a GPS compass, etc.
[0015] The control unit 20 includes a processor (arithmetic unit) such as a CPU, and is configured to be able to execute various types of information processing based on programs stored in the storage unit 30.
[0016] The control unit 20 executes a parameter determination process to determine a parameter related to a distance the ship should keep from an obstacle when avoiding the obstacle, based on obstacle information including position information, type information, and size information of the obstacle on or underwater. The control unit 20 may execute a parameter determination process to determine a parameter related to a distance the ship should keep from an obstacle when avoiding the obstacle, based on obstacle information including position information, type information, and size information of the obstacle on or underwater.
[0017] Here, the parameter related to the distance from an obstacle (appropriate avoidance distance: distance at which the obstacle can be avoided safely and efficiently) that the ship must avoid when avoiding the obstacle may be, for example, a numerical value expressed as the distance [m] from the obstacle. This parameter is stored in advance in the storage unit in association with the position information, type information, and size information of the obstacle. Alternatively, the parameter may be calculated by applying the position information, type information, and size information of the obstacle to a calculation formula stored in advance in the storage unit. For example, if the position of the obstacle is 50 m ahead of the ship (position information), the type of the obstacle is a person (type information), and the size of the obstacle is a planar area of 0.1 m^2 and a height of 1 m (size information), the numerical value of the appropriate avoidance distance corresponding to the conditions (for example, 10 m, etc.) may be determined based on the information in the storage unit.
[0018] FIG. 4 shows an example of appropriate avoidance distances for obstacles A and B located in the traveling direction of the ship 100 in a plan view. The appropriate avoidance distance is indicated by a circle (dash line) centered on the center point of obstacle A and obstacle B. The appropriate avoidance distance can be expressed, for example, as either the distance d1 from the outer surface of the obstacle or the distance d2 from the center of the obstacle. Alternatively, depending on the shape of the obstacle, the appropriate avoidance distance may be set so that a range indicating the shape and size of the hull (including the ship and other ships) expressed as a polygon in a plan view (a pentagon like the ship 100 and obstacle C in FIG. 4, or a triangle, a rectangle, a hexagon, etc.) generates a route that passes outside the separation distance from the obstacle. In the case of a polygon, the line (area) indicating the appropriate avoidance distance has a shape offset by a certain distance from the polygon (the intersection part has an arc shape centered on the intersection), as shown in obstacle C in FIG. 4. In this way, by setting the appropriate avoidance distance according to the shape and size of the obstacle, the same effect can be expected even when the separation distance acquired from the storage unit is applied to ships of different sizes. For example, when the size of the obstacle is small (for example, the area in plan view is 1 m^2 or less, the height from the water surface is 1 m or less, etc.), the appropriate avoidance distance may be set small (for example, 5 m, 10 m, etc.), and the larger the size of the obstacle (for example, the area in plan view is 10 m^2 or more), the larger the appropriate avoidance distance may be set (for example, 20 m, 50 m, etc.). Also, for example, when the obstacle is a person, the appropriate avoidance distance may be set large (for example, 20 m, 50 m, etc.), and when the obstacle is a floating object such as a buoy, driftwood, seaweed, etc., the appropriate avoidance distance may be set small (for example, 5 m, 10 m, etc.). The appropriate avoidance distance may be determined based on appropriate avoidance distance information stored in advance in the storage unit according to at least one of the type and size of the obstacle. In this case, the information on the type and size of the obstacle and the information on the appropriate avoidance distance are stored in advance in association with each other. Furthermore, if the obstacle is another ship, the appropriate avoidance distance may be calculated based on the moving speed and moving direction of the other ship in addition to the position and size information. The moving speed and moving direction of the obstacle such as the other ship may be obtained from the AIS, or may be obtained by combining information from a distance measuring sensor such as a camera and LiDAR, or a camera and RADAR.
[0019] The parameter related to the appropriate avoidance distance is not limited to the numerical value of the distance [m] from the obstacle itself, but may be, for example, a variable (score) associated with the distance [m] from the obstacle. Specifically, it may be a score expressed on a scale of 1 to 10, and any association may be made, such as a score of 1 indicating a distance of 5 m, a score of 2 indicating a distance of 10 m, and a score of 3 indicating a distance of 50 m.
[0020] The obstacle information can include at least any of the following: information acquired from the data acquisition unit 10, information generated by the control unit 20, information pre-stored in the memory unit 30, information input via the input unit 40, and information received from external devices, other ships, etc. via the communication unit 60.
[0021] The control unit 20 can further determine the above parameters based on the moving speed information of the obstacle. For example, the parameters can be set so that the appropriate avoidance distance increases as the moving speed of the obstacle increases. The moving speed information of the obstacle and the parameter information can be stored in advance in association with each other in the storage unit. Also, a calculation formula showing the relationship between the moving speed information and the parameters may be stored in the storage unit.
[0022] The control unit 20 can further determine the above parameters based on the moving direction information of the obstacle. For example, when the moving direction of the obstacle is a direction toward the ship, the parameters can be set so that the appropriate avoidance distance is greater than when the moving direction of the obstacle is a direction away from the ship. The moving direction information of the obstacle and the parameter information can be associated with each other in advance and stored in the storage unit. Also, a calculation formula showing the relationship between the moving direction information and the parameter may be stored in the storage unit. The moving direction may be, for example, a numerical representation of the moving direction (angle) in a specific coordinate system based on the bow direction or the like, or a numerical representation of the moving direction (angle) in a coordinate system based on the north direction.
[0023] The control unit 20 can further determine the above parameters based on the attitude (direction) of the obstacle. For example, when the attitude (bow direction) of a ship as an obstacle is facing the own ship, the parameters can be set so that the appropriate avoidance distance is greater than when the bow direction is the same as that of the own ship. When the obstacle is a person using a surfboard or paddle boat, the parameters can be determined in a similar manner according to the direction (the direction of an object used by a person such as a surfboard, canoe, yacht, or paddle board) and the direction of the person's face. Such information on the attitude of the obstacle and information on the parameters may be stored in advance in association with each other in the storage unit.
[0024] The control unit 20 can execute a navigation route generation process for generating navigation route information for avoiding obstacles and navigating to a destination based on the parameters. The navigation route generation process generates navigation route information for an appropriate avoidance distance from an obstacle based on position information (coordinates) of a start position (e.g., the ship's current position), position information (coordinates) of a destination, 3D map information including the seabed topography, and obstacle information including parameters. At this time, the appropriate avoidance distance is determined based on not only the position information of the obstacle but also size information and, if necessary, type information of the obstacle, thereby enabling safe and efficient navigation without making unnecessary detours.
[0025] The control unit 20 may generate a navigation route using a route search algorithm stored in the storage unit. For example, a cost (numerical value) may be set for each node, which is the smallest unit area obtained by dividing a map (nautical chart), and a search may be performed so that the cost from the node at the start position to the node at the destination is minimized, thereby generating a navigation route. The cost may be an evaluation value indicating the degree of safety, and is basically set based on the water depth, the distance from land, and the like. For example, the shallower the water depth, the higher the cost value, and the closer to land or the like, which is an area where navigation is not possible, the higher the cost value. In setting the cost, a parameter based on the appropriate avoidance distance may be used. For example, the closer a node is to an obstacle, the higher the cost value added to each node, and the cost of a node that is more than the appropriate avoidance distance is set to be equal to or less than a predetermined value. In this way, the numerical value of the cost may be a parameter related to the appropriate avoidance distance. In this case, the predetermined value may be 0 or any value set in advance. A search is performed so that the cost from the departure point to the destination is minimized, using an estimated value of the cost (distance) from each node to the destination. The cost of each node used in route search may be set using any other information in addition to obstacle information and map information (including water depth information and unnavigable area information). For example, the cost may be determined based on meteorological information (including wind direction, wind speed, etc.), ocean current information, wave size information, etc. For example, the higher the wind speed, the higher the cost, the higher the cost of a node where the wind is blowing in the opposite direction to the direction of movement, the higher the cost of a node where an ocean current is occurring in the opposite direction to the direction of movement, and the higher the cost of a node where the waves are larger. The relationship between each of such condition information (parameters) such as meteorological information (including wind direction, wind speed, etc.), ocean current information, and wave size and the numerical value of the cost added to each node is previously associated and stored in the storage unit.
[0026] The control unit 20 may generate a navigation route using a simulation program in the storage unit. For example, when the ship moves along a planned navigation route (a route on which the ship is scheduled to move) at a preset speed (a constant speed or a variable speed set in advance), the control unit 20 may determine the timing at which the ship approaches each obstacle closest to the obstacle, whether the ship will come into contact with the obstacle, the distance to the obstacle when the ship approaches the obstacle closest, and whether the ship approaches the obstacle by more than the appropriate avoidance distance (possibility of appropriate avoidance). By repeatedly executing the simulation program while changing the planned movement route and the ship's speed, the ship can navigate at an appropriate distance from the obstacle and generate (search) a navigation route (including speed information) that can reach the destination in the shortest time. Machine learning based on a predetermined learning model may be used in generating such a navigation route.
[0027] The control unit 20 can execute a ship information estimation process to estimate the ship's position information and the ship's attitude information based on the data (first data) from the data acquisition unit 10. The ship's position information can be estimated using coordinate information as the positioning data acquired by the GNSS module as the current position. The ship's position information may be estimated by a self-position estimation process based on a comparison between map data (three-dimensional point cloud data) acquired from Lidar and map information stored in the storage unit. The ship's position information may be expressed as two-dimensional or three-dimensional coordinate information on a specific coordinate system, and may be expressed in latitude and longitude. The attitude of the ship is expressed as orientation (angle) information in a specific two-dimensional or three-dimensional coordinate system. The attitude information may be expressed in east-west, north-south orientation.
[0028] Here, the position information of the ship can be three-dimensional coordinate information (or two-dimensional coordinate information) of the position of a specific point on the ship. The specific point can be, for example, the center point of the ship, the center of gravity, the installation position of a positioning satellite antenna such as GNSS, or any other predetermined position. The control unit 20 can calculate the position information of the ship based on the position of a data acquisition means such as a positioning satellite antenna, information on the relative positional relationship with the specific point (prestored in the memory unit), and the position information acquired from the data acquisition means. Note that when the position of the data acquisition means is set as the position of the ship, such calculation processing is not necessary.
[0029] Furthermore, the ship's attitude information may be such that the ship's stationary attitude on the water surface is set as a reference attitude, and changes (yaw direction, roll direction, pitch direction) from the reference attitude are detected. In a planar view (two dimensions), the ship's attitude direction may be the direction in which the bow is pointing or any other preset direction. In three dimensions, the ship's attitude information may be based on a direction parallel to the horizontal plane, but a direction upward or downward at any preset angle with respect to the horizontal plane may also be used as the reference attitude.
[0030] The control unit 20 can execute a ship information correction process to correct the ship position information and the ship attitude information based on the data (second data) from the data acquisition unit 10. The control unit 20 can correct the ship position information and the ship attitude information based on speed data acquired from, for example, Lidar or a camera.
[0031] The control unit 20 can execute a speed estimation process to estimate the ship's speed based on data from the data acquisition unit 10. For example, the control unit 20 can calculate the distance traveled in a given time from position information from a given time ago (0.01 seconds, 0.1 seconds, 1 second, etc.) and current position information, and estimate the speed from the information on the distance traveled in the given time. The speed data may be information from a speed sensor serving as the data acquisition unit 10.
[0032] The control unit 20 can execute an obstacle information estimation process to estimate the position and size of an obstacle based on the ship's position information and ship's attitude information corrected in the ship's information correction process, and the data (third data) from the data acquisition unit 10. The control unit 20 may estimate the type information of an obstacle based on the ship's position information and ship's attitude information corrected in the ship's information correction process, and the data (third data) from the data acquisition unit 10. The control unit 20 may estimate the attitude (direction) of the obstacle in the obstacle information estimation process.
[0033] The control unit 20 can estimate the type of obstacle by, for example, selecting one of candidates of obstacle types stored in advance in the storage unit 30. The information on the type of obstacle can include type information such as ships, specific ship classifications (fishing boats, water taxis, small multipurpose boats, recreational fishing boats, passenger boats, transportation boats, work boats, fireboats / patrol boats, pleasure yachts, pleasure motorboats, special work boats, etc.), marine structures, people (including swimming, surfing, yachts, paddle boards, etc.), rocks, shores, driftwood, seaweed, marine life, etc. The information on the type of obstacle is stored in association with size information (area, height).
[0034] The control unit 20 can estimate the position, type, size, and posture of an obstacle by, for example, image analysis of image data acquired by a camera. The control unit 20 may estimate at least one of the position, type, and size of an obstacle by using a machine learning technique using a learning model that has been trained in advance in the obstacle information estimation process. When the control unit 20 estimates the position of an obstacle based on image data acquired by a camera, after estimating the three-dimensional position (coordinates) of the obstacle in the camera coordinate system, the control unit 20 can convert the camera coordinate system into a world coordinate system by a coordinate conversion process based on the information on the camera position (coordinates) and shooting orientation, and calculate the position (coordinates) of the obstacle on the world coordinate system. The control unit 20 can estimate the bow direction of a ship as an obstacle, the direction of a person's face (front direction), and the direction (traveling direction) of an object used such as a surfboard by image analysis of image data from a camera or analysis of three-dimensional data (point cloud data, model data, etc.).
[0035] The storage unit 30 may store candidates for types of obstacles in advance in association with the values of the sizes (information on area and height in a plan view) corresponding to each type, and the ranges of the sizes (upper and lower limits). For example, the range of the area of a ship can be 3 m^2 or more and 9200 m^2 or less, and the range of the height of a ship (height above the water surface) can be 0.5 m or more and 100 m or less. The range of the area of a person can be 0.2 m^2 or more and 5 m^2 or less, and the range of the height of a person (height above the water surface) can be 0.1 m or more and 3 m or less.
[0036] The memory unit 30 stores information on appropriate avoidance distances associated with obstacle information such as the position, type, and size of the obstacle. The memory unit 30 may also store information on a calculation formula for calculating the appropriate avoidance distance. For example, the appropriate avoidance distance may be calculated according to the size (planar area) of the ship as an obstacle. The parameters used in the calculation may include information on the type of obstacle, the moving speed, the moving direction, etc. The memory unit 30 may also store information on a program that simulates the movement of the ship along its own navigation route (planned movement route) and the presence or absence of contact with an obstacle.
[0037] Information about each data acquisition means is stored in the storage unit 30. The information about the data acquisition means may be, for example, the position of the data acquisition means on the ship (e.g., a relative position to a specific point such as the center or center of gravity of the ship), a relative attitude (e.g., a relative direction to the bow direction of the ship), etc., but is not limited thereto.
[0038] The control unit 20 may estimate the moving speed and moving direction of an obstacle based on the ship's position information and ship's attitude information corrected in the ship's information correction process, the ship's moving speed information, moving direction information, and data (third data) from the data acquisition unit 10. The control unit 20 can acquire moving speed information and moving direction information of obstacles such as other ships relative to the ship, based on data from Lidar. The control unit 20 can also acquire moving speed information, moving direction information, etc. of obstacles using data from a radar device.
[0039] In the obstacle information estimation process, the control unit 20 can analyze image data acquired by the camera to estimate information such as the type, size, position, shape, and color of the obstacle. The control unit 20 may estimate the information of the obstacle based on any information of the obstacle estimated from the image data and the obstacle-related information stored in advance in the storage unit. For example, the control unit 20 may estimate the size of the obstacle from the image data, and determine (estimate) an obstacle candidate associated with a size range that matches the size as the type of the obstacle by referring to the storage unit. The control unit 20 may also analyze image data acquired by the camera to estimate the type of the obstacle, and determine (estimate) a size candidate associated with the type as the size of the obstacle by referring to the storage unit. The control unit 20 may also estimate any one of the type, size, and position of the obstacle based on any one or a combination of detection data acquired from a radar device and detection data from Lidar, without being limited to image data acquired by the camera. For example, three-dimensional data of an obstacle can be generated from distance data to multiple points of the obstacle by Lidar, and the three-dimensional shape, type, size, position, etc. of the obstacle can be estimated based on the three-dimensional data of the obstacle. In this way, the control unit 20 can select from among the obstacle candidates by comparing the information of the obstacle candidates stored in the storage unit 30 with the data on the obstacle acquired from the data acquisition unit 10, and estimate the type and size of the detected obstacle. Note that the control unit 20 can also estimate the position, type, and size of the obstacle based only on the data from the data acquisition unit 10.
[0040] The control unit 20 can store various information such as generated information in the storage unit 30, update the information in the storage unit 30, output the information from the output unit 50, and transmit the information to an external device, another ship, etc. via the communication unit 60. The control unit 20 can also accept information acquired by the data acquisition unit 10, user operation information input via the input unit 40, and information received by the communication unit 60, and execute information processing based on the information.
[0041] The memory unit 30 can store various types of information stored in advance, information acquired from the data acquisition unit 10, user operation information input via the input unit 40, information received from external devices or other ships via the communication unit 60, information generated by the control unit 20, etc., and is composed of a non-volatile memory, a hard disk, etc. The memory unit 30 can store information on various parameters indicating the shape of the ship (three-dimensional model data, etc.), characteristics (characteristics related to output, speed, and turning amount), information on obstacles, two-dimensional or three-dimensional map information, navigation history information, navigation route information, tidal information, etc.
[0042] The input unit 40 receives input information based on operations from a user, etc. The input unit 40 is composed of mechanical buttons, switches, operation levers, touch panels, etc. The input unit 40 may also include a microphone that allows voice input.
[0043] The output unit 50 outputs various information as images (video), sounds, etc. The output unit 50 may include, for example, a display unit such as a liquid crystal monitor or a touch panel that displays images, an audio output unit such as a speaker that displays sounds, a vibration generating unit (vibration device) that generates vibrations, etc.
[0044] The communication unit 60 is connected to a network such as the Internet or wireless communication, and is capable of transmitting data to external devices (servers, control devices, etc.) and other ships, and receiving data from external devices.
[0045] The vessel operation control unit 70 may include an auto-rudder that controls steering, an auto-throttle that controls a power unit (engine, motor, etc.) for rotating a propeller or thruster, etc. The vessel operation control unit 70 controls the operation of the vessel 70 (movements such as forward movement, backward movement, left / right movement, turning, etc.) based on instruction information from at least one of the control unit 20, the memory unit 30, the input unit 40, and the communication unit 60, and can navigate the vessel along a predetermined route.
[0046] Fig. 2 shows an example of the present system installed on a ship 100. In the example of Fig. 2, the system includes a Lidar, a camera, a GNSS antenna, an AIS antenna, and a wind speed and direction meter as a data acquisition unit 10, a control unit as a control unit 20, a monitor as an output unit 50, and an auto-rudder and an auto-throttle as a ship operation control unit 70. In the example of Fig. 2, the Lidar and the camera are installed on the front side (bow side) and the rear side (stern side) of the ship 100, respectively, so that data around the ship 100, particularly the front and rear sides, can be detected with high accuracy. The configuration of the present system installed on a ship is not limited to the illustrated example, and other sensors and the like may be included.
[0047] FIG. 3 shows an example of a process flow relating to a method for estimating obstacle information in the system of this embodiment.
[0048] The control unit 20 executes a process (S101) of acquiring obstacle information including position information and size information (and, if necessary, type information) of an obstacle on or underwater, and a process (S102) of determining parameters related to the distance the ship will move away from the obstacle when avoiding the obstacle based on the obstacle information.
[0049] The control unit 20 may execute a process of generating a navigation route or a process of updating a pre-stored navigation route based on the parameters determined in S102 (S103).
[0050] The control unit 20 may execute an output information generating process (S104) for generating output information. The output information may be image data to be displayed on the display unit, audio data to be output as audio, or the like. The image data may include text or image information on the navigation route from the current position to the destination, the position, type, and size of an obstacle, and an indication of the appropriate avoidance distance using numerical values, lines, color differences, or the like. Specifically, the monitor may display a map showing the line indicating the navigation route, the position of an obstacle, and the appropriate avoidance distance, or the type and size of an obstacle may be displayed as text or an image, or an audio output may be output from a speaker to alert the user. In addition, when the ship is steered manually, the output information may be maneuvering information (data on steering, propulsion output, etc.). The output information may also be data for automatically navigating according to the navigation route information by applying it to an autopilot system.
[0051] The control unit 20 can also execute the following processes: an own ship information estimation process for estimating own ship position information and own ship attitude information based on first data acquired from at least one data acquisition means; an own ship information correction process for correcting own ship position information and own ship attitude information based on second data acquired from at least one data acquisition means; an obstacle information estimation process for estimating the position, type, size, etc. of an obstacle based on the own ship position information and own ship attitude information corrected in the own ship information correction process and third data acquired from at least one data acquisition means; and an output information generation process for generating output information based on the information on the position, type, size, etc. of the obstacle estimated in the obstacle information estimation process. The first data, the second data, and the third data may each include data acquired from a common data acquisition means. Also, the first data, the second data, and the third data may each include data acquired from one data acquisition means or from multiple data acquisition means.
[0052] In the ship information estimation process, for example, the ship's three-dimensional position is estimated based on coordinate information from a GNSS antenna as a data acquisition means, and the ship's three-dimensional attitude information is estimated based on orientation data acquired from an inertial measurement unit. The ship information estimation process may be performed based on data acquired from only one data acquisition means, but from the viewpoint of improving estimation accuracy, it is preferable to perform the estimation process based on data acquired from multiple data acquisition means.
[0053] In the ship information correction process, the ship position information and ship attitude information estimated in are corrected based on, for example, speed information acquired from at least one of Lidar and a camera. The control unit 20 estimates the current position and attitude (a predetermined time after the time) using, for example, the position (coordinates), movement direction information, and movement speed information at a time point a predetermined time ago (0.01 seconds, 0.1 seconds, 1 second, etc.). The estimated position and attitude information is then compared with the ship position information and ship attitude information estimated in the ship information estimation process, and if they do not match, the ship position information and ship attitude information can be corrected by adopting the numerical value between the two as accurate current position and current attitude information. Note that the ship information correction process may be performed in a different manner, and for example, the ship position information and ship attitude information may be corrected using the position information and attitude information calculated by the ship position and attitude estimation process based on image data from a camera, or a combination of these. In addition, from the viewpoint of increasing the accuracy of the correction process, it is preferable to perform the correction process based on data acquired from multiple data acquisition means.
[0054] Next, in the obstacle information estimation process, for example, the position and attitude of the camera are estimated based on the ship's position information and ship's attitude information corrected in the ship information correction process (the camera's position and attitude in the ship's coordinate system), and the relative position data of the obstacle in the camera coordinate system is used to perform coordinate conversion to estimate the position of the obstacle in the world coordinate system. Also, the camera's image data is analyzed to estimate the type and size of the obstacle. The position, type, and size of the obstacle may be estimated using detection data acquired from the radar device alone or in combination.
[0055] As described above, in the system of this embodiment, the control unit 20 executes a process for determining a parameter related to the distance the ship should keep away from an obstacle when avoiding the obstacle, based on obstacle information including the position information and size information of the obstacle on or underwater. In this way, by determining a parameter related to an appropriate avoidance distance based on obstacle information including not only the position information of the obstacle but also the size information of the obstacle, safe and efficient navigation without making unnecessary detours is possible.
[0056] Furthermore, the parameter determination process may also determine the parameters based on the moving speed information and moving direction information of the obstacle. In this case, the appropriate avoidance distance can be determined in more detail.
[0057] In the system of this embodiment, the information on the size of the obstacle may include information on the height from the water surface to the top of the obstacle. With this configuration, for example, it is possible to determine an appropriate avoidance distance according to the height of the obstacle. Also, it is possible to improve the accuracy of estimating the type of the obstacle.
[0058] In the system of this embodiment, the type information of the obstacle may include information indicating that the obstacle is another ship or a person. This makes it possible to determine an appropriate avoidance distance according to the type information, such as another ship or a person that requires special attention. In addition, it is also possible to notify the user that the obstacle is another ship or a person, and to urge the user to be careful.
[0059] In the system of this embodiment, the control unit may execute a navigation route generation process for generating navigation route information for avoiding obstacles and traveling to a destination based on the parameters. With this configuration, the vehicle can navigate based on a navigation route that takes into account an appropriate avoidance distance, enabling safer and more efficient navigation.
[0060] In the system of this embodiment, the accuracy of estimating obstacles can be improved by correcting the own ship information estimated by the own ship information correction process before executing the obstacle information estimation process, which makes it easier to avoid contact with obstacles, thereby improving the safety of the ship. Also, according to this embodiment, the above process is repeatedly executed at predetermined intervals such as 0.01 seconds, 0.1 seconds, etc., so that obstacle information can be estimated with high accuracy substantially in real time.
[0061] In the system of this embodiment, the obstacle information estimation process may include a data correction process for correcting the third data based on the ship's position information and ship's attitude information corrected in the ship information correction process. That is, for example, the detection data of the radar device, the image data from the camera, the data from Lidar, etc. as the third data are corrected based on the corrected ship's position information and ship's attitude information, thereby further improving the estimation accuracy of the obstacle. The correction process may include a so-called clustering process, etc.
[0062] In the system of this embodiment, the output information may include information on the distance that the vessel should keep away from the obstacle based on information on the position, type, and size of the obstacle. With this configuration, the vessel can navigate safely and efficiently while avoiding the obstacle.
[0063] In the system of this embodiment, the information on the size of the obstacle may include information on the height from the water surface to the top of the obstacle. With this configuration, for example, it is possible to determine the distance to avoid the obstacle depending on its height, and to improve the accuracy of estimating the type of the obstacle.
[0064] In the system of this embodiment, the obstacle information estimation process may include a process for determining whether the type of obstacle is another ship or a person. With this configuration, for example, it is possible to inform the user that the obstacle is another ship or a person that requires special attention, urge the user to be careful, or allow the user to safely avoid the obstacle.
[0065] In the system of the present embodiment, the first data may include positioning data received from a positioning satellite and data acquired from an inertial measurement unit. With this configuration, the own ship information estimation process can be performed quickly and efficiently.
[0066] In the system of the present embodiment, the second data may include speed data acquired from at least one of the Lidar and the camera. With this configuration, even if the positioning data received from the positioning satellite cannot be acquired, the ship information correction process can be performed with high accuracy.
[0067] In the system of the present embodiment, the third data may include data acquired from Lidar. With such a configuration, for example, information such as the position, type, size, and shape of an obstacle can be estimated with high accuracy using the 3D point cloud data acquired from Lidar.
[0068] In the system of the present embodiment, the third data may include image data acquired from a camera. With this configuration, for example, information such as the relative position, type, size, and shape of an obstacle can be estimated with high accuracy by image analysis of the image data.
[0069] In the system of this embodiment, in environments where signals from positioning satellites cannot be received or signal interference occurs, such as under a bridge, in other words, where GNSS and the like do not function, self-position estimation processing can be performed based on data from at least one of the Lidar and the camera.
[0070] When the control unit 20 determines based on the signal from the data acquisition unit 10 that a signal from a positioning satellite has not been received, the control unit 20 may notify the fact that a signal from a positioning satellite has not been received by using an image or sound from the output unit 50, or may automatically switch the method of ship's position estimation processing. The switching process of the ship's position estimation processing method may be, for example, switching from self-position estimation processing based on data such as GNSS to self-position estimation processing based on data from Lidar and a camera. Then, when it determines that a signal from a positioning satellite has been received again, the method of ship's position estimation processing may be returned to the original method based on data from the positioning satellite.
[0071] In the system of this embodiment, the control unit 20 may determine the type of data to be used in each process based on priority information previously stored in the storage unit 30. For example, in the obstacle information estimation process, the priority can be set in advance such that the combination of camera image data and Lidar data is given the highest priority, followed by camera image data only, Lidar data only, and radar device data only. The priority can be set, for example, taking into consideration high estimation accuracy and low information processing load.
[0072] In the system of this embodiment, the control unit 20 may repeatedly determine whether each data acquisition means is functioning properly based on the presence or absence of a signal from the data acquisition means, and may determine the type of data to be used for each process based on the determination result. For example, if it is determined that GNSS data cannot be acquired, the control unit 20 may execute a ship information estimation process using data acquired by Lidar to estimate the position information and attitude information of the ship.
[0073] Information on the determination result as to whether each data acquisition means is functioning properly or not may be output from the output unit 50 as an image, sound, signal, or the like.
[0074] The system of this embodiment can be installed when a new ship is manufactured, but it can also be implemented on an existing ship by installing various components such as various sensors, cameras, drive devices, power sources, and information processing devices.
[0075] The system of this embodiment can be installed in a newly constructed ship, but can also be installed (retrofitted) in an existing ship. That is, the data acquisition unit 10, control unit 20, storage unit 30, input unit 40, output unit 50, communication unit 60, and ship operation control unit 70 may be entirely or partially formed as a system unit, and the system unit may be installed later in an existing ship.
[0076] In the system of this embodiment, for example, meteorological information and ocean current information may be acquired via the data acquisition unit 10 or the communication unit 60. In this case, for example, by using the meteorological information and ocean current information in at least one of the above-mentioned ship information estimation process, ship information correction process, and obstacle information estimation process, the estimation accuracy of the ship or obstacle can be further improved.
[0077] In the system of this embodiment, output information on obstacles generated by the control unit, and information such as weather information and ocean current information acquired via the data acquisition unit 10 or the communication unit 60 may be transmitted to other ships. In this case, for example, other ships can be notified of emergencies such as natural disasters and accidents. Information may also be shared with rescue teams and the coast guard to respond to marine distress and emergencies.
[0078] In the system of this embodiment, the current position and attitude of the ship may be predicted based on speed data of the ship at a specific point in time in the past, as described above, or the accuracy of estimating the ship's position information and attitude may be improved by predicting the ship's movement using machine learning or the like from information such as parameters indicating the ship's characteristics and navigation history.
[0079] In the system of this embodiment, the control unit may delete unnecessary obstacle information when the obstacle information acquired from the multiple data acquisition means is duplicated. That is, the control unit may perform a duplication determination process to determine whether the multiple obstacle information estimated (detected) by the multiple data acquisition means is the same obstacle or not, and when it is determined that there are two or more obstacle information for one obstacle, it may delete the obstacle information other than one and leave only one obstacle information in the storage unit. The duplication determination process may determine that the position information (coordinates) of another ship acquired by the first data acquisition means (AIS, etc.) and the position information of another ship (obstacle) estimated from the data of the second data acquisition means (camera, Lidar, radar device) are the same, or that the value (distance) indicating the difference between these two points (coordinates) is within a predetermined threshold range. On the other hand, when it is determined that the value (distance) indicating the difference between the two points (coordinates) is outside the predetermined threshold range (exceeds the threshold), it may determine that the two obstacles are different, and the two obstacle information may be maintained without being deleted. The first data acquisition means and the second data acquisition means may be only one data acquisition means or a combination of multiple data acquisition means. The first data acquisition means and the second data acquisition means are assumed to be different data acquisition means, but some of them may be the same data acquisition means.
[0080] In the system of this embodiment, instead of or in combination with the method of avoiding an obstacle by setting an appropriate avoidance distance, a method of avoiding a collision by decelerating (including stopping) the ship and waiting for the obstacle to pass, or a method of avoiding a collision by first crossing the moving direction of the obstacle based on the relative position and relative speed with respect to the obstacle, can be included. In that case, costs are set for all selectable options, and the control unit can calculate the costs for all avoidance methods based on the above-mentioned algorithm and select the route with the lowest cost. In other words, it is not limited to the case where the speed of the ship is constant, but it is possible to generate a movement route that reaches the destination at the minimum cost while securing the appropriate avoidance distance by decelerating and accelerating the speed. In addition, the information on the acceleration (combined deceleration and acceleration per unit time) of deceleration and acceleration, and the parameters of the lower limit and upper limit of the speed can be set according to the type, operating capacity, weight, size, etc. of the hull, and can be stored in the storage unit in advance.
[0081] Furthermore, in the system of this embodiment, a parameter related to cost may be separately set to preferentially select an avoidance route that complies with laws and regulations regarding ship traffic. Specifically, the cost may be set to give priority to the right side as seen from the ship. For example, when trying to avoid an obstacle (another ship) approaching at high speed from the starboard side of the ship, the cost of the ship crossing first may be set to be higher by a predetermined value than the avoidance method of the ship slowing down and waiting for the obstacle to pass. In this case, the cost of slowing down or stopping the ship and waiting for the obstacle to pass may be calculated and compared with the cost of the ship going around the rear of the obstacle to avoid the obstacle. On the other hand, when trying to avoid an obstacle approaching at high speed from the port side of the ship, the cost of the ship crossing first may be set to be lower than the avoidance method of slowing down and waiting for the obstacle to pass.
[0082] Although the preferred embodiment of the present disclosure has been described in detail above with reference to the attached drawings, the technical scope of the present disclosure is not limited to such examples. It is clear that a person having ordinary knowledge in the technical field of the present disclosure can conceive of various modified or amended examples within the scope of the technical ideas described in the claims, and it is understood that these also naturally belong to the technical scope of the present disclosure.
[0083] The device described in this specification may be realized as a single device, or may be realized by a plurality of devices (e.g., cloud servers) partially or entirely connected via a network. For example, the control unit and the storage unit may be realized by different servers connected to each other via a network.
[0084] The series of processes performed by the device described in this specification may be realized using any of software, hardware, and a combination of software and hardware. A computer program for realizing each function of the control unit according to this embodiment may be created and implemented in a PC or the like. A computer-readable recording medium in which such a computer program is stored may also be provided. The recording medium may be, for example, a magnetic disk, an optical disk, a magneto-optical disk, a flash memory, or the like. The above computer program may also be distributed, for example, via a network, without using a recording medium.
[0085] In addition, the processes described herein using flowchart diagrams do not necessarily have to be performed in the order shown. Some process steps may be performed in parallel. Additional process steps may be employed, and some process steps may be omitted.
[0086] In addition, the effects described in this specification are merely descriptive or exemplary and are not limiting. In other words, the technology according to the present disclosure may achieve other effects that are apparent to a person skilled in the art from the description of this specification, in addition to or in place of the above effects.
[0087] Note that the following configurations also fall within the technical scope of the present disclosure. (Item 1) A control unit is provided that executes information processing for avoiding obstacles and navigating to a destination, The control unit of the information processing system executes a parameter determination process to determine parameters related to the distance the ship will move away from an obstacle when avoiding the obstacle, based on obstacle information including position information and size information of the obstacle on or underwater. (Item 2) 2. The information processing system according to item 1, wherein the parameter determination process further determines the parameters based on type information of the obstacle. (Item 3) 3. The information processing system according to item 1 or 2, wherein the parameter determination process further determines the parameter based on at least one of moving speed information and moving direction information of the obstacle. (Item 4) 3. The information processing system according to item 1 or 2, wherein the size information of the obstacle includes information on the height from the water surface to the top of the obstacle. (Item 5) 3. The information processing system according to item 1 or 2, wherein the obstacle type information includes information indicating that the obstacle is another ship or a person. (Item 6) 3. The information processing system according to item 1 or 2, wherein the control unit executes a navigation route generation process to generate navigation route information for avoiding the obstacles and traveling to the destination based on the parameters. (Item 7) The control unit is 3. The information processing system according to item 1 or 2, further comprising: (Item 8) 8. The information processing system according to item 7, wherein the output information includes image data to be displayed on a display unit or audio data to be output as audio. [Explanation of symbols]
[0088] 1. Information Processing Systems 10 Data Acquisition Section 20 Control section 30 Storage section 40 Input section 50 Output section 60 Communications Department 70 Ship motion control unit
Claims
1. A control unit is provided that executes information processing for avoiding obstacles and navigating to a destination, The control unit of the information processing system executes a parameter determination process to determine parameters related to the distance the ship will move away from an obstacle when avoiding the obstacle, based on obstacle information including position information and size information of the obstacle on or underwater.
2. The information processing system according to claim 1 , wherein the parameter determination process further determines the parameter based on type information of the obstacle.
3. The information processing system according to claim 1 , wherein the parameter determination process further determines the parameter based on at least one of moving speed information and moving direction information of the obstacle.
4. The information processing system according to claim 1 , wherein the size information of the obstacle includes information on a height from a water surface to a top of the obstacle.
5. The information processing system according to claim 1 , wherein the obstacle type information includes information indicating that the obstacle is another ship or a person.
6. The information processing system according to claim 1 , wherein the control unit executes a navigation route generation process to generate navigation route information for avoiding the obstacle and traveling to the destination based on the parameters.
7. The control unit is The information processing system according to claim 1 , further comprising: an output information generating process for generating output information based on the parameters.
8. The information processing system according to claim 7 , wherein the output information includes image data to be displayed on a display unit, or audio data to be output as audio.
Citation Information
Patent Citations
Unmanned surface vessel path following guidance method considering hybrid multi-target obstacle avoidance
CN107168335A
Moving route generation method, autonomous moving object, and autonomous moving object control system
JP2008152599A
Control device, control method and program
JP2011200947A
Ship route information generation system and ship route information generation method
JP2022087387A
Movable body control device, movable body control method, and program
JP2023111162A