Autonomous Underwater Vehicle and Control Program

Abstract

To instantaneously grasp in which direction an underwater structure extends ahead of an AUV on the AUV side and reflect it on an operation of the AUV.SOLUTION: An AUV comprises: a hull; a propulsion unit; a contour detector that detects a contour of the top surface of an underwater structure on a section cut obliquely downward from the hull; a control device; and a storage device. The control device includes an acquisition unit that acquires contours detected by the contour detector at predetermined intervals during movement of the hull, a specification unit that stores, for each of the acquired contours, a specific point on the contour in the storage device, an extraction unit that extracts a plurality of specific points positioned before the current position of the hull from among the stored specific points, a straight line calculation unit that calculates a proximate straight line of the extracted specific points; and a propulsion control unit that controls the propulsion unit so as to reduce an angle formed between the cross direction of the hull and the proximate straight line when the hull is seen from the top and reduce a distance between a prescribed place of the hull and the proximate straight line when the hull is seen from the top.SELECTED DRAWING: Figure 4

Description

[Technical field]

[0001] The present invention relates to an autonomous unmanned underwater vehicle and a control program for controlling the operation of the autonomous unmanned underwater vehicle. [Background technology]

[0002] Patent Documents 1 and 2 disclose an autonomous underwater vehicle (AUV, hereinafter also referred to as AUV) that inspects a submarine pipeline while traveling along the pipeline. The hull of the AUV is equipped with detection units such as a multi-beam sonar and a shape recognition laser. The hull of the AUV is controlled to follow the submarine pipeline based on information obtained by the detection units. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] JP 2013-67358 A [Patent Document 2] JP 2019-182214 A Summary of the Invention [Problem to be solved by the invention]

[0004] In order for an AUV to follow an underwater structure extending underwater at high speed, the AUV needs to instantly grasp the direction in which the underwater structure extends in front of the AUV and reflect this in the operation of the AUV. The above-mentioned Patent Documents 1 and 2 do not specifically show how information obtained from a multi-beam sonar or a shape recognition laser is used to control the AUV to follow a submarine pipeline.

[0005] Therefore, the present invention aims to provide an AUV and a control program that can instantly determine the direction in which an underwater structure extends in front of the AUV and reflect this in the operation of the AUV, so that the AUV can track the underwater structure at high speed. [Means for solving the problem]

[0006] In order to solve the above problems, an AUV according to one embodiment of the present invention is an AUV that travels above and along an underwater structure extending underwater, and includes a hull, a propulsion device provided on the hull that is capable of moving the hull in a fore-and-aft direction of the hull and capable of changing its attitude at least in the yaw direction of the hull, a contour detector provided on the hull that detects the contour of the upper surface of the underwater structure in a cross section cut diagonally downward from the hull, and a control device and memory device provided on the hull, and the control device detects the contour of the upper surface of the underwater structure at predetermined intervals while the hull is moving. the contour detector includes an acquisition unit that acquires the contour detected by the contour detector; an identification unit that stores specific points on the contour for each acquired contour in the storage device; an extraction unit that extracts a plurality of specific points that are located forward of a current position of the hull from the stored plurality of specific points; a straight line calculation unit that calculates an approximate straight line of the extracted plurality of specific points; and a propulsion control unit that controls the propulsion device so that an angle between the longitudinal direction of the hull and the approximate straight line becomes small when the hull is viewed from above, and a distance between a predetermined point on the hull and the approximate straight line becomes small when the hull is viewed from above.

[0007] Furthermore, a control program according to one embodiment of the present invention is a control program for controlling the operation of an AUV traveling above and along an underwater structure extending underwater, the AUV comprising a hull, a propulsion device capable of moving the hull in a fore-and-aft direction of the hull and capable of changing the attitude of the hull at least in a yaw direction, a contour detector for detecting a contour of the upper surface of the underwater structure in a cross section cut diagonally downward from the hull, and a memory device, and the contour detected by the contour detector is detected at predetermined intervals while the hull is moving. The computer is caused to function as an acquisition unit that acquires specific points on the contour for each acquired contour, an identification unit that stores in the storage device specific points on the contour for each acquired contour, an extraction unit that extracts a plurality of specific points that are located forward of the current position of the hull from the stored plurality of specific points, a straight line calculation unit that calculates an approximate straight line of the extracted plurality of specific points, and a propulsion control unit that controls the propulsion device so that the angle between the fore-and-aft direction of the hull and the approximate straight line becomes small when viewed from above, and the distance between a predetermined point on the hull and the approximate straight line becomes small when viewed from above.

[0008] According to the above configuration, the AUV can instantly determine the direction in which the underwater structure extends in front of the AUV by a simple calculation of calculating an approximate straight line of multiple specific points of the underwater structure located in front of the hull. In addition, the information obtained by the AUV can be reflected in the operation of the AUV, and the hull can be prevented from moving away from the underwater structure when viewed from above. Therefore, high-speed tracking of the underwater structure by the AUV can be achieved. Effect of the Invention

[0009] According to the present invention, it is possible to provide an AUV and a control program that can instantly determine the direction in which an underwater structure extends in front of the AUV and reflect this in the operation of the AUV, so that the AUV can track the underwater structure at high speed. [Brief description of the drawings]

[0010] [Figure 1]1 is a schematic side view of an AUV according to one embodiment of the present invention. [Diagram 2] 1 is a schematic top view of an AUV according to one embodiment of the present invention; [Diagram 3] FIG. 2 is a block diagram showing the configuration of a control system of the AUV shown in FIG. [Figure 4] 13 is a flowchart showing a flow of an autonomous sailing process. [Diagram 5] 1A is a polar coordinate graph of data detected by a contour detector, and FIG. 1B is a Cartesian coordinate graph obtained by converting the polar coordinate graph shown in FIG. 1A into a Cartesian coordinate system. [Figure 6] FIG. 1 is a schematic top view of a subsea pipeline and an AUV traveling along the subsea pipeline. [Figure 7] FIG. 2 is a schematic side view of a subsea pipeline and an AUV traveling along the subsea pipeline. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0011] Hereinafter, an AUV according to one embodiment of the present invention will be described with reference to the drawings.

[0012] Fig. 1 is a schematic side view of the AUV 1 according to this embodiment, and Fig. 2 is a schematic top view of the AUV 1 according to this embodiment. In this embodiment, the AUV 1 travels above and along an underwater structure extending in water.

[0013] The underwater structure is, for example, a submarine pipeline P. In Figs. 1 and 2, a submarine pipeline P with its lower half buried in the seabed G is shown as an underwater structure extending below the AUV 1. The submarine pipeline P extends horizontally underwater (under the sea) or on the water bottom (sea bottom). The submarine pipeline P may have its lower half buried in the seabed G, or may be supported by a support member extending upward from the seabed G.

[0014] Most of the submarine pipeline P basically extends horizontally, with some parts slightly inclined relative to the horizontal. A cross section of the outer surface of the submarine pipeline P perpendicular to the extension direction is circular. The submarine pipeline P has a uniform shape in the extension direction. In the specification and claims of this application, "water" means liquid in which the AUV 1 can navigate, such as the sea or a lake, and "underwater", for example, includes under the sea or in a lake.

[0015] As shown in Fig. 1, the AUV 1 includes a hull 2, a propulsion device 3 provided on the hull 2, and a control device 4 that controls the propulsion device 3. The hull 2 ​​accommodates a battery (not shown).

[0016] A coordinate system (hereinafter referred to as the "AUV coordinate system") is set in advance for the hull 2. The AUV coordinate system includes a front-rear axis X1, a left-right axis X2, and an up-down axis X3 that are mutually perpendicular. The origin O of the AUV coordinate system is a predetermined point on the hull 2. When the hull 2 ​​travels parallel to an underwater structure that extends horizontally in a straight line, the hull 2 ​​basically travels such that the front-rear axis X1 of the AUV coordinate system is parallel to the extension direction of the underwater structure, the left-right axis X2 of the AUV coordinate system is parallel to the horizontal direction, and the up-down axis X3 of the AUV coordinate system is parallel to the vertical direction. In the specification and claims of this application, the concept of the direction of the AUV 1 is a direction based on the AUV coordinate system.

[0017] For example, the front part of the hull 2 ​​has a streamlined shape that reduces water resistance.

[0018] The propulsion device 3 is configured to move the hull 2 ​​in the fore-aft, left-right and up-down directions of the hull 2, and to change the attitude of the hull 2 ​​in the yaw and pitch directions. The yaw direction of the hull 2 ​​is the direction of rotation about the up-down axis X3 of the AUV coordinate system, and the pitch direction of the hull 2 ​​is the direction of rotation about the left-right axis X2 of the AUV coordinate system. The propulsion device 3 includes multiple thrusters. Note that in the drawings, only thrusters provided at the rear of the hull 2 ​​are shown, and other thrusters are omitted.

[0019] The control device 4 is housed in the hull 2. The control device 4 controls the propulsion device 3 so that the hull 2 ​​travels along the submarine pipeline P without contacting the submarine pipeline P. The control device 4 controls the propulsion device 3 based on data acquired from various devices provided in the hull 2. The method of controlling the propulsion device 3 by the control device 4 will be described in detail later.

[0020] The hull 2 ​​is provided with a contour detector 5, an inertial navigation system 6, a speed measuring device 7 and a memory device 8.

[0021] The contour detector 5 detects at least the contour of the upper surface of the submarine pipeline P in a cross section cut in a direction diagonally downward toward the front of the hull 2. The contour detector 5 is provided in a slightly lower portion of the front part of the hull 2. The contour detector 5 is, for example, a profiling sonar. The contour detector 5 irradiates an acoustic beam radially (in a fan shape) when viewed along the up-down axis X3 as shown by the dashed dotted line in FIG. 2, and acquires the contours of the upper surfaces of the submarine pipeline P and the seabed G as point cloud data. In other words, the contour detector 5 does not have to detect the contour of the detection target as a line, and may detect multiple points on the contour from which the contour can be grasped.

[0022] The contour detector 5 is fixed to the hull 2 ​​so that, when viewed along the left-right axis X2, the irradiation direction of the beam from the contour detector 5 is a forward diagonally downward direction that forms an irradiation angle θ with respect to the downward direction along the up-down axis X3, as shown by the dashed dotted line in Fig. 1. For example, the irradiation angle θ is any angle within the range of 20° to 70°, preferably 30° to 45°.

[0023] The inertial navigation system 6 (INS) detects the acceleration and attitude of the hull 2. The inertial navigation system 6 includes an accelerometer that detects acceleration in the direction in which each of three mutually perpendicular axes extends, and a gyro sensor that detects angular velocity around each of the three axes. In this embodiment, the origin and three axes of the coordinate system of the inertial navigation system 6 respectively coincide with the origin O and the three axes X1, X2, and X3 of the above-mentioned AUV coordinate system. However, the origin and three axes of the coordinate system of the inertial navigation system 6 do not necessarily have to respectively coincide with the origin O and the three axes X1, X2, and X3 of the above-mentioned AUV coordinate system.

[0024] The speed measuring device 7 measures the speed of the hull 2. For example, the speed measuring device 7 is a Doppler Velocity Log (DVL). The Doppler Velocity Log is a device that emits several acoustic beams to the seabed G and measures the ground speed from the reflected or scattered waves from the seabed G.

[0025] The control device 4 calculates the position and attitude of the hull 2 ​​in a geographic coordinate system (longitude, latitude, altitude) using an inertial navigation system 6 and a speed measuring device 7. Therefore, the control device 4 can convert any coordinate in the AUV coordinate system into a coordinate in the geographic coordinate system.

[0026] The storage device 8 stores measurement results, calculation results, and the like obtained by various devices provided in the hull 2. The storage device 8 is, for example, a hard disk, a flash memory, an optical disk, or the like.

[0027] A robot arm 10 extends from the bottom of the hull 2. The robot arm 10 is controlled by a control device 4. A tool 14 is provided at the tip of the robot arm 10. In this embodiment, while the hull 2 ​​travels along the submarine pipeline P without contacting the submarine pipeline P, the robot arm 10 brings the tool 14 into contact with the submarine pipeline P, or brings the tool 14 close to the submarine pipeline P so that the distance between the submarine pipeline P and the tool 14 falls within a predetermined range.

[0028] The robot arm 10 is a vertically articulated robot arm. Specifically, the robot arm 10 has a first link 11, a second link 12, and a third link 13. That is, the robot arm 10 is a robot arm having three degrees of freedom.

[0029] In this embodiment, the first link 11 is connected to the boat body 2 by a joint 11a so as to be rotatable about a first axis C1 parallel to the vertical axis X3. The second link 12 is connected to the first link 11 by a joint 12a so as to be rotatable about a second axis C2 perpendicular to the first axis C1. The third link 13 is connected to the second link 12 by a joint 13a so as to be rotatable about a third axis C3 perpendicular to both the first axis C1 and the second axis C2. The third link 13 is a long arm member. However, the position and configuration of the robot arm 10 are not limited to this. For example, the first axis C1 of the first link 11 may extend in a direction that intersects perpendicularly or obliquely with a straight line parallel to the vertical axis X3.

[0030] The joints 11a, 12a, and 13a are provided with driving units 11b, 12b, and 13b, respectively (see FIG. 3). The driving units 11b, 12b, and 13b are, for example, servo motors. Furthermore, the joints 11a, 12a, and 13a are provided with position sensors that detect the rotation angle positions of the servo motors. The control device 4 controls the driving units 11b, 12b, and 13b based on the rotation angle position information from the position sensors. The tip end of the robot arm 10 is controlled to be positioned rearward of the base end of the robot arm 10.

[0031] The tool 14 is connected to a tip end of a long third link 13. One or more joints may be interposed between the tool 14 and the tip end of the third link 13. In this case, a drive unit controlled by the control device 4 may be provided in one or all of the one or more joints between the tool 14 and the third link 13. Alternatively, a drive unit may not be provided in any of the one or more joints between the tool 14 and the third link 13.

[0032] The tool 14 includes one or more inspection devices for inspecting or maintaining the submarine pipeline P. For example, the inspection device possessed by the tool 14 is a corrosion prevention inspection device for inspecting the degree of deterioration of anti-corrosion treatment (e.g., anti-corrosion coating) of the submarine pipeline P. The inspection device possessed by the tool 14 is not limited to the corrosion prevention inspection device, and may be a camera for imaging the outer surface of the submarine pipeline P, or may be a wall thickness inspection device capable of inspecting the wall thickness of the submarine pipeline P using, for example, ultrasound.

[0033] When the hull 2 ​​travels along the submarine pipeline P while the tool 14 is in contact with the submarine pipeline P, the tool 14 may have wheels or the like as a contact part that comes into contact with the submarine pipeline P.

[0034] 3 is a block diagram showing the configuration of a control system of the AUV 1 shown in FIG. The control device 4 is electrically connected to the propulsion device 3, the contour detector 5, the inertial navigation system 6, the speed measuring device 7, the storage device 8, and the robot arm 10. Note that the control device 4 does not need to directly acquire data from the contour detector 5, the inertial navigation system 6, and the speed measuring device 7. For example, the data measured by the contour detector 5, the inertial navigation system 6, and the speed measuring device 7 may be stored in the storage device 8, and the control device 4 may indirectly acquire the data from the contour detector 5, the inertial navigation system 6, and the speed measuring device 7 via the storage device 8.

[0035] In terms of hardware, the control device 4 has, for example, a processor, a volatile memory, a non-volatile memory, and an I / O interface. In terms of functionality, the control device 4 has an acquisition unit 31, a determination unit 32, a first extraction unit 33, a first line calculation unit 34, a propulsion control unit 35, a second extraction unit 36, a second line calculation unit 37, and an arm control unit 38. The acquisition unit 31, the determination unit 32, the first extraction unit 33, the first line calculation unit 34, the propulsion control unit 35, the second extraction unit 36, the second line calculation unit 37, and the arm control unit 38 are realized by a processor (computer) performing arithmetic processing using a volatile memory based on a control program stored in the non-volatile memory.

[0036] (Autonomous navigation processing) The acquisition unit 31, the identification unit 32, the first extraction unit 33, the first straight line calculation unit 34, and the propulsion control unit 35 execute an autonomous navigation process for the AUV 1 to follow the submarine pipeline P. The autonomous navigation process will be described with reference to Fig. 4 showing the flow of the autonomous navigation process.

[0037] The acquisition unit 31 acquires the contours detected by the contour detector 5 at predetermined intervals while the hull 2 ​​is moving (step S1). The interval at which the acquisition unit 31 acquires the contours may be a predetermined time interval (e.g., several tens of milliseconds) or a predetermined distance interval over which the hull 2 ​​travels. The acquisition unit 31 may change the predetermined interval at which it acquires multiple contours depending on the speed of the AUV 1.

[0038] Fig. 5(a) is a polar coordinate graph of data detected by the contour detector 5. In Fig. 5(a), the horizontal axis is the angle α of the acoustic beam with respect to a plane perpendicular to the left-right axis X2 passing through the acoustic beam emission port (see also Fig. 2), and the vertical axis is the distance from the acoustic beam emission port to the reflecting surface (i.e., the seabed G or the upper surface of the submarine pipeline P). Fig. 5(b) is an orthogonal coordinate graph obtained by converting the polar coordinate graph shown in Fig. 5(a) into a Cartesian coordinate system. The acquisition unit 31 acquires the Cartesian coordinate system data from the contour detector 5 and converts it into the AUV coordinate system.

[0039] Thereafter, the identifying unit 32 stores in the storage device 8 a specific point on the contour for each contour acquired by the acquiring unit 31 (step S2). In this embodiment, the identifying unit 32 identifies a point on the contour that satisfies the condition that it is the uppermost point in the up-down direction of the contour of the submarine pipeline P as the specific point.

[0040] In this embodiment, the identifying unit 32 uses the least squares method to extract an ellipse that is approximated by a point cloud estimated to constitute the contour of the upper surface of the submarine pipeline P, as shown by a two-dot chain line in Fig. 2, from the point cloud data of the contour of the upper surface of the submarine pipeline P. Then, the identifying unit 32 calculates the position coordinates of the uppermost point of the extracted ellipse as the position of the identified point.

[0041] There is no particular limitation on the method by which the identification unit 32 identifies the uppermost point of the contour of the submarine pipeline P. The identification unit 32 may extract an ellipse using a Hough transform instead of the least squares method. In addition to extracting an ellipse using the Hough transform or the least squares method, the contour and the uppermost point of the submarine pipeline P may be calculated by template matching.

[0042] After identifying the uppermost point of the contour of the submarine pipeline P as the specific point, the identification unit 32 converts the coordinates of the specific point in the AUV coordinate system into coordinates in the geographic coordinate system and stores them in the storage device 8. In this way, one specific point is stored in the storage device 8 at regular intervals.

[0043] The first extraction unit 33 extracts a plurality of specific points located forward of the current position of the hull 2 ​​(e.g., the position of the origin O in the AUV coordinate system) from the stored plurality of specific points (i.e., the position coordinates of the plurality of specific points) (step S3).

[0044] FIG. 6 is a schematic top view of a submarine pipeline P and an AUV 1 traveling along the submarine pipeline P. In FIG. 6, a specific point X identified by the identification unit 32 on the submarine pipeline P is s-3 ,X s-2 ,X s-1 ,X s ,…,X t-3 ,X t-2 ,X t-1 ,X t In addition, a specific point located forward of the current position of the hull 2 ​​is indicated by a subscript including t, and a specific point located aft of the current position of the hull 2 ​​is indicated by a subscript including s. The most recently identified specific point is X t The current position of the hull 2 ​​may be defined as the position of the origin O in the AUV coordinate system, for example, or as the position of the base end of the robot arm 10.

[0045] In step S3, the first extraction unit 33 extracts a specific point X tIn this embodiment, the first extraction unit 33 changes the number of specific points to be extracted from the stored specific points in accordance with the speed measured by the speed measuring device 7. For example, the first extraction unit 33 extracts, from the multiple specific points stored in the storage device 8, in order from the most recent, a number of specific points corresponding to the speed of the hull 2.

[0046] The first line calculation unit 34 calculates a first approximate line L1 of the extracted specific points (step S4). The first approximate line L1 is a line in a geographic coordinate system, which is a three-dimensional coordinate system. The first approximate line L1 calculated by the first line calculation unit 34 is also shown in FIG.

[0047] The propulsion control unit 35 controls the propulsion device 3 so that when viewed from above, the angle between the fore-and-aft direction of the hull 2 ​​(i.e., the fore-and-aft axis X1) and the first approximate line becomes small, and when viewed from above, the distance between the origin O in the AUV coordinate system and the first approximate line L1 becomes small (step S5).

[0048] 7 is a schematic side view of a submarine pipeline P and an AUV 1 traveling along the submarine pipeline P. In step S5, the propulsion control unit 35 controls the propulsion device 3 so that, when the hull 2 ​​is viewed from the side, the angle between the fore-and-aft direction of the hull 2 ​​(i.e., the fore-and-aft axis X1) and the first approximate straight line L1 becomes smaller.

[0049] By repeating steps S1 to S5, the AUV 1 navigates autonomously along the undersea pipeline P.

[0050] (Arm control processing) While the hull 2 ​​is moving, the control device 4 executes an arm control process for bringing the tool 14 into contact with the submarine pipeline P, or for bringing the tool 14 closer to the submarine pipeline P so that the distance between the tool 14 and the submarine pipeline P falls within a predetermined range. The arm control process is executed by the acquisition unit 31, the identification unit 32, the second extraction unit 36, the second straight line calculation unit 37, and the arm control unit 38. The arm control process will be described below with reference to Figs. 6 and 7.

[0051] In the arm control process, similar to steps S1 and S2 of the autonomous cruising process, the contour of the submarine pipeline P is obtained and specific points are identified and stored. In other words, the specific points stored in the storage device 7 in step S2 of the autonomous cruising process are also used in the arm control process.

[0052] The second extraction unit 36 ​​extracts a plurality of specific points rearward of the current position of the hull 2 ​​from the plurality of specific points stored in step S2 as arm extraction points. The second line calculation unit 37 calculates an approximation line of the extracted arm extraction points as the second approximate line L2. Figures 6 and 7 also show the second approximate line L2 calculated by the second line calculation unit 37. The second approximate line L2 is a line in the geographic coordinate system, which is a three-dimensional coordinate system.

[0053] In this embodiment, the second extraction unit 36 ​​extracts two specific points. Specifically, the second extraction unit 36 ​​extracts a first specific point X 1 located inside a boundary surface B that defines the movable range of the robot arm 10. s , and the specific portion 32 is outside the boundary surface B and is a first specific point X s The second specific point X identified just before identifying s-1 6 and 7, the boundary surface B is indicated by a dashed line. The second line calculation unit 37 then extracts the first specific point X s and the second specific point X s-1 A straight line passing through these points is calculated as the second approximate straight line L2.

[0054] The arm control unit 38 controls the robot arm 10 so that the tip of the robot arm 10, that is, the tool 14, is positioned at the intersection of the boundary surface B and the second approximate straight line L2.

[0055] In this way, the arm control processing replaces the processing of the first extraction unit 33 in step S3 in the autonomous navigation processing with processing of the second extraction unit 36, replaces the processing of the first line calculation unit 34 in step S4 with processing of the second line calculation unit 37, and replaces the processing of the propulsion control unit 35 in step S5 with processing of the arm control unit 38. By repeating these steps, the tool 14 can be maintained in a position where the submarine pipeline P can be inspected and maintained.

[0056] As described above, with the AUV1 according to this embodiment, a simple calculation of calculating the first approximate straight line L1 of multiple specific points on the submarine pipeline P located in front of the hull 2 ​​allows the AUV1 to instantly grasp in which direction the submarine pipeline P extends in front of the AUV1. Furthermore, the information grasped by the AUV1 can be reflected in the operation of the AUV1, so that the hull 2 ​​can be prevented from moving away from the submarine pipeline P when viewed from above. Therefore, high-speed tracking of the submarine pipeline P by the AUV1 can be achieved.

[0057] Furthermore, in this embodiment, a second approximate straight line L2 of a plurality of specific points of the submarine pipeline P located in front of the hull 2 ​​is calculated, and the robot arm 10 is controlled so that the tip of the robot arm 10 is positioned at the intersection of a predetermined curved surface B within the movable range of the robot arm 10 and the second approximate straight line L2. Therefore, with a simple calculation, the robot arm 10 can be controlled so that the distance between the tip of the robot arm 10 and the underwater structure is maintained within a certain range.

[0058] (Other embodiments) The present invention is not limited to the above-described embodiment, and various modifications are possible without departing from the gist of the present invention.

[0059] For example, the underwater structure that the hull 2 ​​follows is not limited to the submarine pipeline P, and the shape of the underwater structure is not limited to a circular cross section. The underwater structure that the hull 2 ​​follows may be, for example, a cover structure that covers the submarine pipeline P.

[0060] The underwater structure that the boat body 2 follows is not limited to one with a circular outer surface. For example, the outer surface of the underwater structure may be a rectangle having two horizontal sides and two vertical sides. In this case, the identification unit 32 may identify a point on the contour that satisfies the condition that it is the center point in the left-right direction of the contour as the specific point. The specific point does not have to be the uppermost point of the underwater structure. When the underwater structure has a horizontal uppermost surface, one end in the left-right direction of the uppermost surface may be the specific point in a cross section perpendicular to the extension direction of the underwater structure. When the upper surface of the underwater structure has a groove extending in the extension direction, the groove portion may be the specific point. In this case, the identification unit 32 may calculate the specific point of the underwater structure by template matching.

[0061] In addition, in the above embodiment, the hull 2 ​​navigates along the submarine pipeline P without contacting the submarine pipeline P, but the hull 2 ​​may navigate along the underwater structure while contacting the underwater structure.

[0062] The shapes and configurations of the hull 2, the robot arm 10 and the tool 14 are not limited to those described in the above embodiment. In addition, the robot arm 10 may be connected to the rear part of the hull 2 ​​instead of the lower part of the hull 2.

[0063] The propulsion device 3 does not have to include multiple thrusters and may be a single oscillating thruster. The propulsion device 3 is configured to be able to move the hull 2 ​​in the front-rear direction, left-right direction, and up-down direction of the hull 2, but it is sufficient that the propulsion device 3 is configured to be able to move the hull 2 ​​at least in the front-rear direction.

[0064] Furthermore, although the propulsion devices 3 are configured to be able to change their attitude in the yaw and pitch directions of the hull 2, it is sufficient that the propulsion devices 3 are configured to be able to change their attitude at least in the yaw direction of the hull 2. The propulsion control unit 35 does not need to control the pitch direction to reduce the angle between the fore-aft direction of the hull 2 ​​(i.e., the fore-aft axis X1) and the first approximate line L1 when viewed from the side. In the above embodiment, the first approximate line L1 and the second approximate line L2 are calculated as straight lines in a three-dimensional coordinate system, but they may also be calculated as straight lines in a two-dimensional coordinate system excluding the dimension in the height direction in a geographic coordinate system, for example.

[0065] In the above embodiment, the propulsion control unit 35 controlled the propulsion device 3 so as to reduce the distance between the origin O in the AUV coordinate system and the first approximate straight line L1 when viewing the hull 2 ​​from above, but the propulsion device 3 may also be controlled so as to reduce the distance between a point on the hull 2 ​​other than the origin O in the AUV coordinate system and the first approximate straight line L1.

[0066] The contour detector 5 does not have to be a profiling sonar, but may be a device that detects the contour of the upper surface of an underwater structure in a cross section cut in a direction diagonally downward and forward from the hull 2. For example, the contour detector 5 may be a laser range finder that radiates a light beam, rather than an acoustic beam, radially in a direction diagonally downward and forward from the hull 2.

[0067] The speed measuring device 7 does not have to be a Doppler speed log. The inertial navigation system 6 may function as the speed measuring device 7. In other words, the inertial navigation system 6 may calculate the speed of the hull 2 ​​from the detected acceleration of the hull 2.

[0068] In the above embodiment, the control device 4 calculates the position of the hull 2 ​​in the geographic coordinate system using the inertial navigation system 6 and the speed measuring device 7, but the device (hereinafter, "coordinate information acquisition device") that acquires information necessary for calculating the position information of the hull 2 ​​in the geographic coordinate system is not limited to this. For example, the coordinate information acquisition device may be an acoustic positioning device provided in the hull 2. For example, the control device 4 may use an acoustic positioning device provided in the hull to acoustically locate the position of the hull 2 ​​relative to a reference position whose geographic coordinate system is known. In this case, the AUV 1 does not need to be equipped with the speed measuring device 7 as the coordinate information acquisition device. The acoustic positioning method is not particularly limited, and may be any of LBL (Long Base Line), SBL (Short Base Line), and SSBL (Super Short Base Line). The reference position may be the position of a transponder installed in advance on the seabed, or the position of a mother ship equipped with a GPS that navigates on the sea above the hull 2.

[0069] In the above embodiment, the identification unit 32 converted the coordinates of the specific point in the AUV coordinate system into coordinates in the geographic coordinate system and stored them in the storage device 8, but the identification unit 32 may also store the coordinates of the specific point in the AUV coordinate system directly in the storage device 8. In this case, however, the stored past specific point needs to be corrected according to the movement of the AUV 1 before it is used for calculating an approximate straight line, etc.

[0070] In the above embodiment, the second line calculation unit 37 calculates the first specific point X s and the second specific point X s-1 However, the method of calculating the second approximate line L2 is not limited to this. For example, s and the second specific point X s-1 An approximation line of three or more specific points including the above may be calculated as the second approximation line L2.

[0071] The arm control unit 38 controlled the robot arm 10 so that the tip of the robot arm 10 is positioned at the intersection of the boundary surface B that defines the movable range of the robot arm 10 and the second approximate straight line L2, but the arm control unit 38 may also control the robot arm 10 so that the tip of the robot arm 10 is positioned at the intersection of the second approximate straight line L2 and another curved surface within the movable range of the robot arm 10. The robot arm 10 may be a robot arm having four or more degrees of freedom.

[0072] The underwater structure may include at least one of a subsea pipeline and a cover structure covering the subsea pipeline.

[0073] The identifying unit may identify a point on the contour that satisfies either one of a condition that the point is the center point in the left-right direction of the contour and a condition that the point is the uppermost point in the up-down direction of the contour as the specific point. With this configuration, it is easy to set the specific point on the center line of the underwater structure when viewed from above.

[0074] The approximate line may be a line in a three-dimensional coordinate system, the propulsion unit 3 may be capable of changing its attitude in the pitch direction of the hull, and the propulsion control unit may control the propulsion unit 3 so as to reduce an angle between the approximate line and the fore-and-aft direction of the hull when viewed from the side. With this configuration, the direction in which the hull moves when viewed from the side can be made closer to the extension direction of an underwater structure in front of the hull. This makes it possible to prevent the hull from getting too close to or too far away from the underwater structure when viewed from the side.

[0075] The AUV1 may have a speed measuring device that measures the speed of the hull, and the extraction unit may change the range or number of the multiple specific points to be extracted from the multiple stored specific points in accordance with the speed measured by the speed measuring device. With this configuration, it is possible to calculate an approximation line suitable for preventing the hull from separating from the underwater structure.

[0076] The AUV may further include a robot arm extending from the hull, the extraction unit and the straight line calculation unit being a first extraction unit and a first straight line calculation unit, respectively, and the control device may further include a second extraction unit that extracts a plurality of the specific points rearward of a current position of the hull from the stored plurality of specific points as arm extraction points, a second straight line calculation unit that calculates an approximation line of the extracted arm extraction points as a second approximation line, and an arm control unit that controls the robot arm so that the tip of the robot arm is positioned at the intersection of a predetermined curved surface within a movable range of the robot arm and the second approximation line. With this configuration, the robot arm can be controlled by a simple calculation so as to maintain the distance between the tip of the robot arm and an underwater structure within a certain range.

[0077] The predetermined curved surface may be a boundary surface that defines the movable range of the robot arm.

[0078] The second extraction unit may extract, as the arm extraction points, a first specific point inside the boundary surface and a second specific point outside the boundary surface that is identified by the identification unit immediately before identifying the first specific point, and the second line calculation unit may calculate, as the second approximation line, a line passing through the first specific point and the second specific point. With this configuration, it is easy to calculate the second approximation line that extends in the same direction as the portion of the underwater structure near the tip of the robot arm.

[0079] The control program is stored in a storage device. The storage device is a readable / writable or readable device that is built into or external to a computer, and may be, for example, a hard disk, a flash memory, an optical disk, etc. The program stored in the storage device may be executed in a computer to which the storage device is directly connected, or may be downloaded and executed in a computer connected to the storage device via a network (e.g., the Internet). [Explanation of symbols]

[0080] 1:AUV (Autonomous Unmanned Underwater Vehicle) 2: Hull 3: Propulsion device 4: Control device 5: Contour detector 6: Inertial navigation system 7: Speed ​​measuring device 8: Storage device 10: Robot arm 31: Acquisition part 32: Specific part 33: 1st extraction part 34: First straight line calculation section 35: Propulsion control unit 36:Second extraction part 37: Second straight line calculation section 38: Arm control section P: Subsea pipeline G: Undersea

Claims

1. An autonomous unmanned underwater vehicle that travels above and along an underwater structure extending underwater, The hull and a propulsion device provided on the hull, capable of moving the hull in a fore-and-aft direction of the hull and capable of changing the attitude of the hull at least in a yaw direction; a contour detector provided on the hull for detecting a contour of an upper surface of the underwater structure in a cross section cut in a direction obliquely downward toward the front of the hull; A control device and a storage device provided in the hull, The control device includes: an acquisition unit that acquires the contour detected by the contour detector at predetermined intervals while the hull is moving; a specifying unit that stores a specific point on the contour in the storage device for each of the acquired contours; an extraction unit that extracts a plurality of the specific points located forward of a current position of the hull from the plurality of stored specific points; a straight line calculation unit that calculates an approximation straight line of the extracted specific points; and a propulsion control unit that controls the propulsion device so that an angle between the fore-and-aft direction of the hull and the approximate straight line becomes small when viewed from above, and a distance between a predetermined point on the hull and the approximate straight line becomes small when viewed from above.

2. The autonomous unmanned underwater vehicle according to claim 1 , wherein the underwater structure includes at least one of a subsea pipeline and a cover structure covering the subsea pipeline.

3. 3. The autonomous unmanned underwater vehicle according to claim 1 or 2, wherein the identification unit identifies as the specific point a point on the contour that satisfies either one of the conditions that the point is the center point of the contour in the left-right direction and the condition that the point is the top point of the contour in the up-down direction.

4. the approximation line is a line in a three-dimensional coordinate system, The propulsion device is capable of changing its attitude in a pitch direction of the hull, The autonomous unmanned submersible vehicle according to any one of claims 1 to 3, wherein the propulsion control unit controls the propulsion device so that an angle between the fore-and-aft direction of the hull and the approximate straight line is reduced when the hull is viewed from the side.

5. A speed measuring device for measuring the speed of the hull, The autonomous unmanned submersible vehicle according to any one of claims 1 to 4, wherein the extraction unit changes the range or number of the multiple specific points to be extracted from the multiple stored specific points depending on the speed measured by the speed measuring device.

6. Further comprising a robot arm extending from the hull, the extraction unit and the straight line calculation unit are a first extraction unit and a first straight line calculation unit, respectively; The control device includes: a second extraction unit that extracts, from the stored plurality of specific points, a plurality of specific points that are rearward of a current position of the hull as arm extraction points; a second line calculation unit that calculates an approximation line of the extracted arm extraction points as a second approximation line; 6. The autonomous unmanned submersible vehicle according to claim 1, further comprising: an arm control unit that controls the robot arm so that a tip end of the robot arm is positioned at an intersection of a predetermined curved surface within a movable range of the robot arm and the second approximation straight line.

7. The autonomous unmanned underwater vehicle according to claim 6 , wherein the predetermined curved surface is a boundary surface that defines the movable range of the robot arm.

8. the second extraction unit extracts, as the arm extraction points, a first specific point that is inside the boundary surface and a second specific point that is outside the boundary surface and that is identified by the identification unit immediately before identifying the first specific point; The autonomous unmanned underwater vehicle according to claim 7 , wherein the second straight line calculation unit calculates a straight line passing through the first specific point and the second specific point as the second approximation straight line.

9. A control program for controlling an operation of an autonomous unmanned underwater vehicle traveling above and along an underwater structure extending underwater, comprising: the autonomous unmanned submersible vehicle comprises a hull, a propulsion device capable of moving the hull in a fore-and-aft direction of the hull and capable of changing the attitude of the hull at least in a yaw direction, a contour detector that detects a contour of an upper surface of the underwater structure in a cross section cut in a direction obliquely downward and forward from the hull, and a memory device; an acquisition unit that acquires the contour detected by the contour detector at predetermined intervals while the hull is moving; a specifying unit that stores a specific point on the contour in the storage device for each of the acquired contours; an extraction unit that extracts a plurality of the specific points located forward of a current position of the hull from the plurality of stored specific points; a straight line calculation unit that calculates an approximation straight line of the extracted specific points; a propulsion control unit that controls the propulsion device so that an angle between a front-to-rear direction of the hull and the approximate line becomes small when viewed from above the hull, and a distance between a predetermined point of the hull and the approximate line becomes small when viewed from above the hull; A control program that enables a computer to function.

Images