POSITION CONTROL SYSTEM AND POSITION CONTROL METHOD FOR AN UNMANNED SURFACE VEHICLE
20170212516 ยท 2017-07-27
Inventors
Cpc classification
B63B2035/006
PERFORMING OPERATIONS; TRANSPORTING
B63B2021/007
PERFORMING OPERATIONS; TRANSPORTING
International classification
B63B35/00
PERFORMING OPERATIONS; TRANSPORTING
Abstract
An unmanned surface vehicle for underwater investigation that is free from negative effect of a thruster is provided. A position control system for an unmanned surface vehicle includes: at least one mooring device fixed on the ground; a wire fed and wound from the mooring device; an unmanned surface vehicle connected at the tip end of the wire; and at least one rudder equipped on the unmanned surface vehicle, wherein the mooring device includes a mooring device control means for controlling the feeding and winding of the wire, and a rudder control means for drive-controlling the rudder, the mooring device control means and the rudder control means control the position of the unmanned surface vehicle to reach the target.
Claims
1. A position control system for an unmanned surface vehicle, comprising: at least one mooring device fixed on the ground; a wire fed and wound from the mooring device; an unmanned surface vehicle connected at the tip end of the wire; and at least one rudder equipped on the unmanned surface vehicle, wherein the mooring device includes a mooring device control means for controlling the feeding and winding of the wire, the unmanned surface vehicle includes a GPS and an inertia measurement apparatus for sensing the position and posture of the unmanned surface vehicle, an angle sensing means for the rudder, and a rudder control means for drive-controlling the rudder, the mooring device control means and the rudder control means include communication systems for sending and receiving the information of each control apparatus, and the mooring device control means and the rudder control means control the position of the unmanned surface vehicle to reach the target.
2. The position control system according to claim 1, wherein the total number of the mooring devices and the rudders is three or more.
3. The position control system according to claim 1, further comprising at least one of the following three mechanisms: a wire connection point (WCP) shifting mechanism of that can shift a wire connection point between the wire and the unmanned surface vehicle, a center of gravity (COG) shifting mechanism that can shift the center of gravity of the unmanned surface vehicle, and a rudder shifting mechanism that can shift a position of the rudder.
4. The position control system according to claim 1, wherein the number of the mooring device fixed on the ground is one, the number of the rudders is two, and the two rudders are provided at the stern side or one rudder is provided at the stern side and the other one rudder is provided at the bow side.
5. The position control system according to claim 1, wherein the rudder control means includes a worm gear.
6. The position control system according to claim 1, wherein the unmanned surface vehicle further includes a thruster.
7. A position control method of controlling the position of an unmanned surface vehicle in a position control system including, at least one mooring device fixed on the ground, a wire fed and wound from the mooring device, an unmanned surface vehicle connected at the tip end of the wire, and at least one rudder equipped on the unmanned surface vehicle, the unmanned surface vehicle including a GPS and an inertia measurement apparatus for sensing its own position and posture, and an angle sensing means for the rudder, the position control method comprising: drive-controlling, by the mooring device control means, the feeding and winding of a wire; drive-controlling, by the rudder control means, the rudder; and mutually sending and receiving, by the mooring device control means and the rudder control means, information of the respective control means to control the position of the unmanned surface vehicle to reach the target.
8. The position control method according to claim 7, wherein the total number of the mooring devices and the rudders is three or more.
9. The position control method according to claim 7, wherein the unmanned surface vehicle further includes at least one of the following three mechanisms: a WCP shifting mechanism that can shift a wire connection point between the wire and the unmanned surface vehicle, a COG shifting mechanism that can shift the center of gravity of the unmanned surface vehicle, and a rudder shifting mechanism that can shift a position of the rudder.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0020]
[0021]
[0022]
[0023]
[0024]
[0025]
[0026]
[0027]
[0028]
[0029]
[0030]
[0031]
[0032]
[0033]
[0034]
[0035]
[0036]
[0037]
[0038]
[0039]
[0040]
DESCRIPTION OF THE EMBODIMENTS
[0041] Generally, an unmanned surface vehicle in flowing water receives forces such as a gravitational force, a buoyant force, a drag force, or a lift force. Here, it is assumed that the vertical movement of the unmanned surface vehicle is ignored and that the horizontal movement is mainly subjected to a drag force and a lift force. The resultant force of a drag and a lift force is called as a fluid force. It is conserved the fluid force and tension of the wire as a horizontal external force acting on the unmanned surface vehicle. Furthermore, it is assumed that the unmanned surface vehicle is moored by i wires and the unmanned surface vehicle includes k rudders.
p.sub.b,.sub.b,
[0042] denote the position vector from the center of gravity G of the unmanned surface vehicle 1 and the posture vector between the center line of the unmanned surface vehicle 1 ah and a water flow direction dc, respectively,
p.sub.d,p.sub.c(h),p.sub.r(j)
[0043] denote the position vector from the center of gravity G of the unmanned surface vehicle 1 to each application point of the fluid force applied to the draft of the unmanned surface vehicle 1, the wire h, and the rudder, respectively. Note that symbols 21, 11, and 12 shown in
[0044] In this case, the force vector Fb acting on the gravity center G of the unmanned surface vehicle 1 and the moment vector Mb are represented by the following equations.
[0045] Thus, the unmanned surface vehicle 1 has a dynamic equation established as shown below.
[0046] The fluid force vectors Fd and Fr(j) are divided into the drag vectors fDd and fDr(j) and the lift force vectors fLd and fLr(j) and can be represented by the following equations.
F.sub.d=f.sub.Dd+f.sub.Ld
F.sub.r(j)=f.sub.Dr(j)+f.sub.Lr(j)
[0047] In the following description, when a variable Xn is used, the index n represents d or r. When n is d, the variable represents the draft of the unmanned surface vehicle and, when n is r, the variable represents the rudder. It is assumed that the fluid density is , the relative velocity vector of the object (the draft or rudder) to the fluid is vn, the object (the draft or rudder) to a plane vertical to the fluid flow has a projection area SDn, the object (the draft or rudder) to a plane parallel to the fluid flow has a projection area SLn, the drag coefficient is CDn, the lifting power coefficient is CLn, and a unit vector vertical to the relative velocity vector vn within the horizontal plane is epn. In this case, the drag vector fDn and the lifting power vector fLn acting on the draft and the rudder of the unmanned surface vehicle are determined by the following equations.
f.sub.Dd=|v.sub.d|v.sub.dS.sub.DdC.sub.Dd
f.sub.Ld=|v.sub.d|.sup.2e.sub.pdS.sub.LdC.sub.Ld
f.sub.Dr(j)=|v.sub.r(j)|v.sub.r(j)S.sub.Dr(J)C.sub.Dr(j)
f.sub.Lr(j)=|v.sub.r(j)|.sup.2e.sub.prS.sub.Lr(J)C.sub.Lr(j)
[0048] Thus, the mechanism constants mb and Ib and the density p can be known and the values of the coefficients CDn and CLn can be obtained by an experiment. Then, the relative velocity vector vn and the projection areas SDn and SLn and the position vector
p.sub.d,p.sub.c(h),p.sub.r(j)
[0049] can be calculated. Furthermore, the tension vectors Fc(h) of all wires can be measured by a sensor. Alternatively, it is assumed that all wires are modeled by a spring or a damper for example and the wire tension vector Fc(h) can be calculated based on the elongation. In this case, the resultant force Fb applied to the gravity center of the unmanned surface vehicle and the total moment Mb can be calculated. Thus, based on the dynamic equation, the positions and the postures of the unmanned surface vehicle at the respective timings can be calculated. As described above, the general behavior of the moored unmanned surface vehicle can be expressed by the dynamic equations with the four equations for the fluid force.
Control Example 1 of a Target Movement in the Case where the Configuration is Composed of One Mooring Device and One Rudder
[0050]
Disadvantage Regarding the Target Movement Control in the Case where the Configuration is Composed of One Mooring Device and One Rudder
[0051] To keep the vessel body stationary at the target point in running water in the case that the wire length is constant, it is necessary to control the wire angle to be the target angle. The wire angle can be controlled by one rudder as shown in the control example 1, however the wire angle and the posture of the vessel cannot be controlled at the same time because the number of the control input is just one. To control the two parameters, another control input is required.
Control Example 2 of the Target Movement in the Case where the Configuration is Composed of One Mooring Device 1 and One Rudder and a Rudder Shifting Mechanism
[0052] Following the method shown in the control example 1, the wire angle reaches to the target angle by control of the rudder angle 11. At that time, the resultant force and moment vector Fb and Mb can be zero (Fb=0 and Mb=0) when controlling the rudder angle 41 suitably and the position of the rudder from Prjl shown in
Control Example 3 of the Target Movement in the Case where the Configuration is Composed of One Mooring Device, One Rudder, and a Wire Connection Point Shifting Mechanism
[0053] Following the method shown in the control example 1, the wire angle reaches to the target angle by control of an angle of the rudder 11. At that time, the resultant force and moment vector Fb and Mb can be zero (Fb=0 and Mb=0) when controlling the rudder angle suitably and the position of the wire connection point (WCP) from Pcj shown in
Control Example 4 of the Target Movement in the Case where the Configuration is Composed of One Mooring Device, One Rudder, and a Gravity Center Shifting Mechanism
[0054] Following the method shown in the control example 1, the wire angle reaches to the target angle by control of an angle of the rudder 11. At that time, the resultant force and moment vector Fb and Mb can be zero (Fb=0 and Mb=0) when controlling the rudder angle suitably and the position of the vessel body gravity center G shown in
Control Example 5 of the target movement in the case where the configuration is composed of one mooring device and two rudders
[0055] Setting an angle of the rudder 72 in
[0056] .sub.b=0,
Fb=0 and Mb=0 can be achieved by the rudder control.
[0057] When controlling the two rudders of the unmanned surface vehicle at the position of the unmanned surface vehicle 1a in
Control Example 6 of the Target Movement in the Case where the Configuration is Composed of One Mooring Device and Two Rudders
[0058]
[0059] As shown in the control examples 2 to 5, the position of the unmanned surface vehicle 1 can be defined by including: at least one mooring devices 2 provided at the land side; a wire fed and wound from the mooring device 2; an unmanned surface vehicle 1 connected to a tip end of the wire; and at least one rudders 11, 12 provided in the unmanned surface vehicle 1. The total number of the mooring devices and the rudders is three or more. Alternatively, the unmanned surface vehicle includes the one mooring device, the one rudder, and a rudder shifting mechanism. Alternatively, the unmanned surface vehicle includes the one mooring device, the one rudder, and a WCP shifting mechanism. Alternatively, the unmanned surface vehicle includes the one mooring device, the one rudder, and a gravity center shifting mechanism.
Basic Configuration of the Control System
[0060]
[0061] When the system includes only one mooring device and one rudder and the position and posture of the unmanned surface vehicle are controlled, the unmanned surface vehicle must include, in addition to the mooring device and the rudder, at least one of a rudder shifting mechanism 111 that can move the rudder installation position, a WCP shifting mechanism 112 that can move a point at which the wire is connected to the unmanned surface vehicle, and a center of gravity (COG) shifting mechanism 113 that can move the gravity center of the unmanned surface vehicle. The control of the rudder shifting mechanism 111, the WCP shifting mechanism 112, and the COG shifting mechanism 113 requires a sensor 103 for sensing the travel distance of the object moving on the respective mechanisms and a drive control means (CPU).
[0062] The GPS inertia measurement apparatus provided in the unmanned surface vehicle can be used to sense the position and posture of the unmanned surface vehicle. However, these apparatuses are insufficient to sense a loose wire. To handle this, the tension is prevented from being zero by providing an apparatus to measure the wire feed amount or a wire tension sensor that can sense a loose wire. Furthermore, the mooring device fixed on the land side allows the moored position to be easily identified. Thus, the position and posture of the unmanned surface vehicle can be calculated without the GPS inertia measurement apparatus by allowing the mooring device to include the wire length sensing means and the wire angle sensing means and by allowing the unmanned surface vehicle to include the wire angle sensing means, respectively. However, a loose wire prevents the position and posture of the unmanned surface vehicle from being correctly calculated. Therefore, when the GPS inertia measurement apparatus is not used, then the tension must be prevented from being reached by providing, for example, a wire tension sensor that can sense a loose wire or a clutch that can prevent a certain tension or less from being reached.
[0063] Alternatively, the addition of a thruster 104 can provide the position control using the rudder even when there is no flow.
Example of the Generation of a Terrain Map Using Sonar
[0064] In order to measure the shape of a river bed or a bed protection by sonar to generate a terrain map, the unmanned surface vehicle 1 must be moved thoroughly within a target region so as to eliminate any measurement failure. Generally, the direction along which a sonar beam bm is emitted is a direction vertical to the direction along which the vessel body travels as shown in
[0065] In order to move the unmanned surface vehicle along the wavelike trajectory of the dash line of
(System Example Composed of Two Mooring Devices and One Rudder)
[0066]
A Modification Example of a System Composed of Two Mooring Devices and One Rudder
[0067]
A System Example Composed of a Catamaran Unmanned Surface Vehicle, One Mooring Device, and Two Rudders 2
[0068]
[0069]
[0070]
(An Example in which a Rudder Driving Unit Uses a Worm Gear)
[0071]
[0072] The use of the system of the present invention can reduce disturbance caused by the thruster driving because the system can control the position of the unmanned surface vehicle 1 without using thruster during the underwater observation. This system can be generally used for the underwater observation of a river or a weir for example.