EP2107333A1 - Method and system for steering a body moving within a fluid - Google Patents
Method and system for steering a body moving within a fluid Download PDFInfo
- Publication number
- EP2107333A1 EP2107333A1 EP08425219A EP08425219A EP2107333A1 EP 2107333 A1 EP2107333 A1 EP 2107333A1 EP 08425219 A EP08425219 A EP 08425219A EP 08425219 A EP08425219 A EP 08425219A EP 2107333 A1 EP2107333 A1 EP 2107333A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- steering
- yaw
- pitch
- steering commands
- rotation
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 239000012530 fluid Substances 0.000 title description 5
- 238000012795 verification Methods 0.000 claims abstract 2
- 238000004590 computer program Methods 0.000 claims 1
- 230000014509 gene expression Effects 0.000 description 11
- 241000251729 Elasmobranchii Species 0.000 description 3
- 230000002301 combined effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Images
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F42—AMMUNITION; BLASTING
- F42B—EXPLOSIVE CHARGES, e.g. FOR BLASTING, FIREWORKS, AMMUNITION
- F42B19/00—Marine torpedoes, e.g. launched by surface vessels or submarines; Sea mines having self-propulsion means
- F42B19/01—Steering control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63G—OFFENSIVE OR DEFENSIVE ARRANGEMENTS ON VESSELS; MINE-LAYING; MINE-SWEEPING; SUBMARINES; AIRCRAFT CARRIERS
- B63G8/00—Underwater vessels, e.g. submarines; Equipment specially adapted therefor
- B63G8/14—Control of attitude or depth
- B63G8/20—Steering equipment
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B63—SHIPS OR OTHER WATERBORNE VESSELS; RELATED EQUIPMENT
- B63H—MARINE PROPULSION OR STEERING
- B63H25/00—Steering; Slowing-down otherwise than by use of propulsive elements; Dynamic anchoring, i.e. positioning vessels by means of main or auxiliary propulsive elements
- B63H25/02—Initiating means for steering, for slowing down, otherwise than by use of propulsive elements, or for dynamic anchoring
- B63H25/04—Initiating means for steering, for slowing down, otherwise than by use of propulsive elements, or for dynamic anchoring automatic, e.g. reacting to compass
Definitions
- the present invention relates to a method and a system for steering a body moving, whether self-propelled, guided, or drawn, within a fluid; in particular, the following description will make explicit reference to an underwater vehicle, for example, a torpedo.
- Figure 1a is a schematic view of a steering system 1, of a known type, for controlling the movement of a body 2, for example, a torpedo having a cylindrical body with substantially circular cross section.
- the steering system 1 comprises four rudders 3, which define a pair of horizontal control surfaces 4a, arranged in the horizontal reference plane xy associated to the body 2 (defined by the longitudinal direction x and the transverse direction y), and a pair of vertical control surfaces 4b arranged in the vertical reference plane xz associated to the body 2 (defined by the longitudinal direction x and the vertical direction z).
- rudders 3 which define a pair of horizontal control surfaces 4a, arranged in the horizontal reference plane xy associated to the body 2 (defined by the longitudinal direction x and the transverse direction y), and a pair of vertical control surfaces 4b arranged in the vertical reference plane xz associated to the body 2 (defined by the longitudinal direction x and the vertical direction z).
- the control of the roll movement of the body 2 (represented by a roll momentum Mx about the longitudinal axis x) is achieved by means of a composition of the deflections of some or all of the horizontal and vertical control surfaces 4a, 4b.
- the first and second control loops acting respectively in the vertical reference plane xz and horizontal reference plane xy, can be considered at least partially free and hence operate according to logics defined specifically for each reference plane.
- FIG 1b shows a different steering system 1, of the type commonly known as "butterfly-rudder system".
- the four rudders 3 are in this case arranged to form a non-zero angle (for example, a 45° angle) with the transverse axis y and vertical axis z, and define control surfaces 5.
- the rudders 3 are arranged on mutually opposite sides, and in a position that is symmetrical with respect to the horizontal reference plane xy and vertical reference plane xz.
- the deflection of any one of the control surfaces 5 acts simultaneously on the horizontal reference plane xy (by means of the horizontal component Fy of the applied force F), the vertical reference plane xz (by means of the vertical component Fz of the applied force F) and the transverse reference plane yz (by means of the resultant roll momentum Mx) .
- torpedoes have control limitations, due to the small dimensions of the moving control surfaces, which are constrained by their necessary placement in the launching tubes (the cross section of the launching tubes limiting the maximum dimension of these surfaces), and moreover due to the wide dynamics of the speed of movement of torpedoes, which can go from low speeds (for example, for reducing the noise when approaching a target) to high speeds (for example, when reaching a target).
- This wide dynamics of the speed sets limitations on the control of the movement of torpedoes, given that, in a known way, the effectiveness of the moving control surfaces depends, among other elements, upon the speed of the moving body.
- a butterfly-rudder steering system proves to be more complex to implement in so far as it requires the definition of algorithms that take into account the combined effects that the deflection of each of the moving control surfaces has on the three reference planes, in order to determine the commands for the deflections to be imparted on the rudders according to the required movement.
- the aim of the present invention is consequently to provide a method and a system for steering a body in a fluid that will be optimized as regards the management of the moving control surfaces, in particular for bodies subject to structural limitations in the control of the movement.
- the present invention stems from the observation, by the Applicant, of the need, in steering systems subject to structural control limitations (for example, due to dimensional limitations of the moving control surfaces and/or to a wide dynamics of the speed of movement), to distribute in an optimized manner, on independent rudders, steering commands imparted simultaneously in the three reference planes.
- One aspect of the present invention consequently envisages the definition of an algorithm designed to distribute the commands for steering of the rudders, taking into account the limitations associated to the steering system, so as to obtain the desired behaviour during execution of the required manoeuvres, exploiting in an optimal manner the deflections that can be applied to each rudder.
- Figure 2 shows an underwater vehicle 10, in particular a self-propelled torpedo having control surfaces with small dimensions, provided with a steering system 11 designed to control submarine movement thereof.
- the steering system 11 comprises an arrangement 12 of rudders 13, including four rudders 13 in a "butterfly" arrangement (as described previously as regards Figure 1b ), each of which can be controlled individually for generating the rotation of the underwater vehicle 10 about a longitudinal axis x of its own (roll movement), a transverse axis y of its own (pitch movement), or a vertical axis z of its own (yaw movement).
- the rudders 13 are generally divided, on the basis of a position thereof with respect to the horizontal and transverse planes of symmetry of the underwater vehicle 10 considered in the direction of its movement, into: an upper-right (UR) rudder, an upper-left (UL) rudder, a lower-left (LL) rudder, and a lower-right (LR) rudder.
- UR upper-right
- UL upper-left
- LL lower-left
- LR lower-right
- the steering system 11 further comprises: actuator means 14, for example, provided with electric motors, operatively coupled to the rudders 13 for controlling deflection thereof; and a central control unit 15, connected to the actuator means 14 and provided with processing means (for example, microprocessor means), designed to execute appropriate software programs and instructions for controlling desired deflections of the rudders 13 through the actuator means 14.
- actuator means 14 for example, provided with electric motors, operatively coupled to the rudders 13 for controlling deflection thereof
- processing means for example, microprocessor means
- the central control unit 15 receives values of commanded trim (in terms of roll, pitch, yaw) in the three, horizontal, vertical, and transverse, reference planes for the movement of the underwater vehicle 10, from a wire-guide system (not illustrated) that connects the underwater vehicle 10 to a naval support vehicle (not illustrated), or else, in the absence of a wire-guide system (for example, in the process of homing towards a target), generates said values autonomously, according to an attack plan.
- the central control unit 15 On the basis of these commanded values and corresponding measurements made by sensors of the underwater vehicle 10, the central control unit 15 generates the commands for the deflections to be imparted on the rudders 13 for each of the three reference planes, which are considered independent.
- the simultaneous control in the three reference planes is obtained by summing algebraically for each of the four rudders 13 the deflections assigned for the control in the three reference planes. This is possible where the sum of the controlled deflections does not exceed for any rudder 13 a maximum applicable deflection.
- An aspect of the present invention consequently consists in configuring the central control unit 15 so as to process and modify the commanded deflections in order to determine, based on an optimized distribution algorithm, the commands for the optimal deflections to be imparted on each of the rudders 13.
- the distribution algorithm envisages, in an initial block 20, the reception (or autonomous generation) by the central control unit 15 of commanded deflections of roll ⁇ p, pitch ⁇ q and yaw ⁇ r, respectively for the rotation of the underwater vehicle 10 about the longitudinal axis x, the transverse axis y, and the vertical axis z.
- the controlled deflections are understood as being positive where they produce clockwise rotations about the respective axes of reference.
- a procedure of optimized distribution of the commanded deflections imparted on the four rudders 13 is then initiated, with the purpose of preventing any saturation that might bring the rudders 13 to an end-of-travel and of respecting a priority criterion of the commands to be executed in the reference planes.
- this priority criterion envisages, in the case where a total commanded deflection is greater than a value that would lead the rudders 13 to saturation, the definition of a priority in controlling some reference planes with respect to others, ensuring in any case a minimum deflection for each reference plane.
- a check is made to verify whether the sum of the commanded deflections of pitch ⁇ q and yaw ⁇ r, considered in absolute value, is less than a maximum deflection ⁇ max that can be made by the rudders 13 (without causing end-of-travel saturation), for example, equal to 20°.
- a comparison is made between the absolute value of the commanded deflection of yaw ⁇ r and a guaranteed minimum value of yaw ⁇ r min , for example, 5°.
- a check is made to verify whether the absolute value of the commanded deflection of pitch ⁇ q is lower than a guaranteed minimum value of pitch ⁇ q min , for example, 15°.
- the optimized distribution algorithm proceeds to block 27, where the residual band available for the control about the longitudinal axis x is determined.
- the distribution algorithm proceeds with the determination of the total deflections to be applied to the rudders 13, on the basis of the optimized values of the commanded deflections of yaw, pitch and roll ⁇ q, ⁇ r, ⁇ p, as determined previously.
- block 36 first a check is made on the value of the available residual deflection ⁇ .
- deflections to be applied to the rudders 13 for roll control are set to zero (block 37).
- the distribution algorithm envisages determination of two values of deflection for roll control (in this case both set to zero): a first value of roll control ⁇ p UR-LL to be applied to the upper-right (UR) rudder and lower-left (LL) rudder (which produce momenta of rotation in the same direction about the longitudinal axis x), and a second value of roll control ⁇ p LR-UL to be applied to the lower-right (LR) rudder and upper-left (UL) rudder (which produce momenta of rotation in the opposite direction about the longitudinal axis x).
- ⁇ UR , ⁇ LR , ⁇ LL and ⁇ UL are, respectively, the total deflections to be applied to the upper-right rudder, lower-right rudder, lower-left rudder and upper-left rudder (considered positive if they generate clockwise rotations about the longitudinal axis, evaluated in the direction of movement of the underwater vehicle 10).
- the deflections applied to at least three of the four rudders 13 are less than the maximum deflection ⁇ max so as to prevent any end-of-travel saturation of the same rudders, and consequent undesirable behaviour of the moving body.
- the distribution algorithm envisages the use of the available degree of freedom (given the presence of three steering commands applied to four rudders), to distribute the steering commands in an optimized manner.
- the algorithm proposed is particularly effective for control moving bodies having structural limitations of control (for example, due to dimensional and/or dynamic limitations of the moving control surfaces).
- the algorithm described can be modified for ensuring the guaranteed minimum value of yaw ⁇ r min or pitch ⁇ q min even in the case where it is subsequently necessary to perform a scaling of the commands for ensuring the roll control; for example, the operation of scaling (block 34) could regard only the controlled deflection of yaw ⁇ r, guaranteeing a value of the controlled deflection of pitch ⁇ q that is not less than the respective guaranteed minimum value of pitch ⁇ q min .
- the steering system 10 could envisage an arrangement of the rudders 13 different from the butterfly one described and illustrated so far, in which the rudders 13 are in any case independent and capable of generating rotations in the three reference planes.
- the guaranteed minimum values of yaw ⁇ r min and pitch ⁇ q min might not be constant and determined beforehand, but be variable and redefinible during execution of the control operations (for example, by the central control unit 15 or via commands received from the wire-guide system) so as to vary in real time the assignment of priority to the commands in the various reference planes.
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- General Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Ocean & Marine Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
- The present invention relates to a method and a system for steering a body moving, whether self-propelled, guided, or drawn, within a fluid; in particular, the following description will make explicit reference to an underwater vehicle, for example, a torpedo.
- As is known, systems for steering a body (for example, an underwater or air-borne vehicle, or a weapon system, such as a missile or a torpedo) within a fluid (for example, air or water) make use of moving control surfaces carried by the moving body. By imparting commands for appropriate deflections of rudders (which define the aforesaid moving surfaces), rotations of the moving body about its own axes are generated, namely, the longitudinal axis (movement known as "roll"), the transverse axis (movement known as "pitch") and the vertical axis (movement known as "yaw" or "course movement"). In particular, by appropriately combining the commands imparted on the rudders, it is possible to control as desired the movement of the body in the three reference planes: transverse, vertical, and horizontal.
-
Figure 1a is a schematic view of asteering system 1, of a known type, for controlling the movement of abody 2, for example, a torpedo having a cylindrical body with substantially circular cross section. - The
steering system 1 comprises fourrudders 3, which define a pair ofhorizontal control surfaces 4a, arranged in the horizontal reference plane xy associated to the body 2 (defined by the longitudinal direction x and the transverse direction y), and a pair ofvertical control surfaces 4b arranged in the vertical reference plane xz associated to the body 2 (defined by the longitudinal direction x and the vertical direction z). Via deflections of thehorizontal control surfaces 4a, in a first control loop, the pitch movement of thebody 2 is controlled, by applying a vertical force Fz; via deflections of thevertical control surfaces 4b, in a second control loop, the yaw movement of thebody 2 is controlled, by applying a horizontal force Fy. Whilst the control of the roll movement of the body 2 (represented by a roll momentum Mx about the longitudinal axis x) is achieved by means of a composition of the deflections of some or all of the horizontal andvertical control surfaces -
Figure 1b shows adifferent steering system 1, of the type commonly known as "butterfly-rudder system". - The four
rudders 3 are in this case arranged to form a non-zero angle (for example, a 45° angle) with the transverse axis y and vertical axis z, and definecontrol surfaces 5. In particular, therudders 3 are arranged on mutually opposite sides, and in a position that is symmetrical with respect to the horizontal reference plane xy and vertical reference plane xz. The deflection of any one of thecontrol surfaces 5 acts simultaneously on the horizontal reference plane xy (by means of the horizontal component Fy of the applied force F), the vertical reference plane xz (by means of the vertical component Fz of the applied force F) and the transverse reference plane yz (by means of the resultant roll momentum Mx) . - The advantage of such a configuration of the
rudders 3 is that it increases the control surface useful for controlling the movement in each reference plane, and increases the possibility for movement control. This solution is thus potentially effective forsteering bodies 2 that are subject to structural limitations as regards control of the movement. - For example, it is known that torpedoes have control limitations, due to the small dimensions of the moving control surfaces, which are constrained by their necessary placement in the launching tubes (the cross section of the launching tubes limiting the maximum dimension of these surfaces), and moreover due to the wide dynamics of the speed of movement of torpedoes, which can go from low speeds (for example, for reducing the noise when approaching a target) to high speeds (for example, when reaching a target). This wide dynamics of the speed sets limitations on the control of the movement of torpedoes, given that, in a known way, the effectiveness of the moving control surfaces depends, among other elements, upon the speed of the moving body.
- Albeit advantageous for the reasons set forth above, a butterfly-rudder steering system proves to be more complex to implement in so far as it requires the definition of algorithms that take into account the combined effects that the deflection of each of the moving control surfaces has on the three reference planes, in order to determine the commands for the deflections to be imparted on the rudders according to the required movement.
- The aim of the present invention is consequently to provide a method and a system for steering a body in a fluid that will be optimized as regards the management of the moving control surfaces, in particular for bodies subject to structural limitations in the control of the movement.
- According to the present invention, there are consequently provided a steering method and system, as defined in
claim - For a better understanding of the invention, embodiments thereof are now described purely by way of non-limiting example and with reference to the attached drawings, wherein:
-
Figure 1a is a schematic view of a first configuration, of a known type, of moving control surfaces of a body moving in a fluid; -
Figure 1b is a schematic view of a second configuration, of a known type, of the moving control surfaces; -
Figure 2 is a schematic view of an underwater vehicle, in particular a torpedo, provided with a steering system according to one aspect of the present invention; and -
Figures 3a-3c illustrate, as a whole, a flowchart regarding an algorithm for optimized distribution of steering commands for the rudders, implemented in the system ofFigure 2 . - The present invention stems from the observation, by the Applicant, of the need, in steering systems subject to structural control limitations (for example, due to dimensional limitations of the moving control surfaces and/or to a wide dynamics of the speed of movement), to distribute in an optimized manner, on independent rudders, steering commands imparted simultaneously in the three reference planes.
- In fact, application to the rudders of simultaneous steering commands having an amplitude greater than a maximum controllable deflection (which can even be very small, for example due to the aforesaid dimensional or dynamic limitations), could bring some of them to end-of-travel, especially in a condition of low speed. A simple actuation of the rudders to the end-of-travel value would give rise to a dynamic behaviour of the moving body different from desired one (introducing, for example, over-shooting in height during execution of simultaneous commands in the horizontal and vertical reference planes).
- One aspect of the present invention consequently envisages the definition of an algorithm designed to distribute the commands for steering of the rudders, taking into account the limitations associated to the steering system, so as to obtain the desired behaviour during execution of the required manoeuvres, exploiting in an optimal manner the deflections that can be applied to each rudder.
-
Figure 2 shows anunderwater vehicle 10, in particular a self-propelled torpedo having control surfaces with small dimensions, provided with asteering system 11 designed to control submarine movement thereof. - The
steering system 11 comprises anarrangement 12 ofrudders 13, including fourrudders 13 in a "butterfly" arrangement (as described previously as regardsFigure 1b ), each of which can be controlled individually for generating the rotation of theunderwater vehicle 10 about a longitudinal axis x of its own (roll movement), a transverse axis y of its own (pitch movement), or a vertical axis z of its own (yaw movement). In particular, therudders 13 are generally divided, on the basis of a position thereof with respect to the horizontal and transverse planes of symmetry of theunderwater vehicle 10 considered in the direction of its movement, into: an upper-right (UR) rudder, an upper-left (UL) rudder, a lower-left (LL) rudder, and a lower-right (LR) rudder. - The
steering system 11 further comprises: actuator means 14, for example, provided with electric motors, operatively coupled to therudders 13 for controlling deflection thereof; and acentral control unit 15, connected to the actuator means 14 and provided with processing means (for example, microprocessor means), designed to execute appropriate software programs and instructions for controlling desired deflections of therudders 13 through the actuator means 14. In a per-se known manner, thecentral control unit 15 receives values of commanded trim (in terms of roll, pitch, yaw) in the three, horizontal, vertical, and transverse, reference planes for the movement of theunderwater vehicle 10, from a wire-guide system (not illustrated) that connects theunderwater vehicle 10 to a naval support vehicle (not illustrated), or else, in the absence of a wire-guide system (for example, in the process of homing towards a target), generates said values autonomously, according to an attack plan. On the basis of these commanded values and corresponding measurements made by sensors of theunderwater vehicle 10, thecentral control unit 15 generates the commands for the deflections to be imparted on therudders 13 for each of the three reference planes, which are considered independent. In this way, the simultaneous control in the three reference planes is obtained by summing algebraically for each of the fourrudders 13 the deflections assigned for the control in the three reference planes. This is possible where the sum of the controlled deflections does not exceed for any rudder 13 a maximum applicable deflection. An aspect of the present invention consequently consists in configuring thecentral control unit 15 so as to process and modify the commanded deflections in order to determine, based on an optimized distribution algorithm, the commands for the optimal deflections to be imparted on each of therudders 13. - In detail, and with reference to
Figures 3a-3c , the distribution algorithm envisages, in aninitial block 20, the reception (or autonomous generation) by thecentral control unit 15 of commanded deflections of roll δp, pitch δq and yaw δr, respectively for the rotation of theunderwater vehicle 10 about the longitudinal axis x, the transverse axis y, and the vertical axis z. In particular, the controlled deflections are understood as being positive where they produce clockwise rotations about the respective axes of reference. - A procedure of optimized distribution of the commanded deflections imparted on the four
rudders 13 is then initiated, with the purpose of preventing any saturation that might bring therudders 13 to an end-of-travel and of respecting a priority criterion of the commands to be executed in the reference planes. In particular, this priority criterion envisages, in the case where a total commanded deflection is greater than a value that would lead therudders 13 to saturation, the definition of a priority in controlling some reference planes with respect to others, ensuring in any case a minimum deflection for each reference plane. - In greater detail, in a
block 21 subsequent to block 20 a check is made to verify whether the sum of the commanded deflections of pitch δq and yaw δr, considered in absolute value, is less than a maximum deflection δmax that can be made by the rudders 13 (without causing end-of-travel saturation), for example, equal to 20°. - If it is less, the sharing algorithm proceeds as described in what follows with reference to
Figure 3b (the continuation of the procedure is represented by block A inFigures 3a and3b ). Otherwise, a procedure is executed for modifying the value of the commanded deflections of pitch δq and yaw δr, in such a way as to bring at the most just onerudder 13 to end-of-travel, at the same time guaranteeing a minimum control band for the rotations about the transverse axis y and the vertical axis z. - In detail (block 22), a comparison is made between the absolute value of the commanded deflection of yaw δr and a guaranteed minimum value of yaw δrmin, for example, 5°.
-
- The procedure then goes to block A.
- In the case where the above absolute value of the commanded deflection of yaw is higher than the guaranteed minimum value of yaw (block 24), a check is made to verify whether the absolute value of the commanded deflection of pitch δq is lower than a guaranteed minimum value of pitch δqmin, for example, 15°. In particular, the guaranteed minimum values of yaw and pitch δrmin, δqmin are chosen so that their sum is equal to the maximum deflection δmax
- In addition, the assignment of a higher value to one of the two guaranteed minimum values of yaw or pitch δrmin, δqmin enables assignment of a priority to the control of the respective movement of yaw or pitch.
-
- The procedure then goes to block A.
- Otherwise, i.e., if both the commanded deflection of yaw δr and the commanded deflection of pitch δq are greater than or equal to the respective guaranteed minimum value of yaw or pitch δrmin, δqmin, the values of the commanded deflection of yaw δr and of the commanded deflection of pitch δq are modified and set equal to the respective guaranteed minimum value of yaw or pitch δrmin, δqmin (block 26), according to the expressions
- The procedure then continues to block A. The choice of the guaranteed minimum value of yaw or pitch δrmin, δqmin enables in this case assignment of a greater deflection to one of the commanded deflections of yaw δr and pitch δq with respect to the other, attributing to them a greater priority of control.
- From block A (see
Figure 3b ), the optimized distribution algorithm proceeds to block 27, where the residual band available for the control about the longitudinal axis x is determined. In detail, an available residual deflection δσ for control of the roll, distributed over the fourrudders 13, is determined according to the expression - A check is then made (block 28) to verify whether the absolute value of the controlled deflection of roll δp is lower than the available residual deflection δσ calculated previously. If it is lower, the distribution algorithm proceeds as described in what follows with reference to
Figure 3c (the continuation of the procedure is represented by block B inFigures 3b and3c ). - Otherwise, if it is not, a check is made to verify (block 29) whether the available residual deflection δσ is greater than a guaranteed minimum value of roll δpmin (which represents a guaranteed minimum control band for the rotation about the longitudinal axis x), for example, 2°.
-
- Otherwise, if it is not, a check is made (block 32) to verify whether the commanded deflection of roll δp is in absolute value greater than the guaranteed minimum value of roll δpmin.
-
- If it is not, and also from
block 33 the procedure goes to block 34, where the commanded deflections of yaw and pitch δq, δr, previously modified, are reduced in percentage terms according to an appropriate scaling coefficient ksc to take into account the deflection lacking for the required roll control (a check has in fact been made to verify that the available residual deflection δσ is smaller than the guaranteed minimum value of roll δpmin) . In detail, the scaling coefficient ksc is determined according to the expression
and the commanded deflections of yaw and pitch δq, δr are modified according to the expressions -
- The procedure then goes to block B.
- From block B (see
Figure 3c ), the distribution algorithm proceeds with the determination of the total deflections to be applied to therudders 13, on the basis of the optimized values of the commanded deflections of yaw, pitch and roll δq, δr, δp, as determined previously. - In detail, block 36, first a check is made on the value of the available residual deflection δσ.
- If the available residual deflection δσ is zero (condition indicating the fact that no control in roll is made), deflections to be applied to the
rudders 13 for roll control are set to zero (block 37). In particular, the distribution algorithm envisages determination of two values of deflection for roll control (in this case both set to zero): a first value of roll control δpUR-LL to be applied to the upper-right (UR) rudder and lower-left (LL) rudder (which produce momenta of rotation in the same direction about the longitudinal axis x), and a second value of roll control δpLR-UL to be applied to the lower-right (LR) rudder and upper-left (UL) rudder (which produce momenta of rotation in the opposite direction about the longitudinal axis x). -
- Next, in block 40, from which access is gained both at output from block 37 and at output from block 38, the distribution algorithm ends with determination of the total deflections to be applied to the
rudders 13, according to the expressions
where δUR, δLR, δLL and δUL are, respectively, the total deflections to be applied to the upper-right rudder, lower-right rudder, lower-left rudder and upper-left rudder (considered positive if they generate clockwise rotations about the longitudinal axis, evaluated in the direction of movement of the underwater vehicle 10). - The advantages that the steering method and system described enable are clear from the foregoing discussion.
- They enable a reduction in the time of execution of the manoeuvres (compatibly with the dynamic capabilities of the rudders 13), safeguarding a priority of execution assigned to the control of the movement in the various reference planes and guaranteeing minimum control bands for the movements of yaw, pitch, and roll. In particular, the deflections applied to at least three of the four
rudders 13 are less than the maximum deflection δmax so as to prevent any end-of-travel saturation of the same rudders, and consequent undesirable behaviour of the moving body. The distribution algorithm envisages the use of the available degree of freedom (given the presence of three steering commands applied to four rudders), to distribute the steering commands in an optimized manner. - As previously highlighted, the algorithm proposed is particularly effective for control moving bodies having structural limitations of control (for example, due to dimensional and/or dynamic limitations of the moving control surfaces).
- Finally, it is clear that modifications and variations may be made to what is described and illustrated herein, without departing from the scope of the present invention, as defined by the annexed claims.
- In particular, the algorithm described can be modified for ensuring the guaranteed minimum value of yaw δrmin or pitch δqmin even in the case where it is subsequently necessary to perform a scaling of the commands for ensuring the roll control; for example, the operation of scaling (block 34) could regard only the controlled deflection of yaw δr, guaranteeing a value of the controlled deflection of pitch δq that is not less than the respective guaranteed minimum value of pitch δqmin .
- In addition, the optimal distribution of the deflection for roll control on the opposite pairs of rudders is applicable in principle also to the configuration of rudders illustrated in
Figure 1a (which presents pairs of horizontal and vertical rudders). - The
steering system 10 could envisage an arrangement of therudders 13 different from the butterfly one described and illustrated so far, in which therudders 13 are in any case independent and capable of generating rotations in the three reference planes. - The order of the comparisons made between the commanded deflections of yaw δr and pitch δq and the respective guaranteed minimum values of yaw δrmin and pitch δqmin (blocks 22 and 24) could be reversed.
- In addition, the guaranteed minimum values of yaw δrmin and pitch δqmin might not be constant and determined beforehand, but be variable and redefinible during execution of the control operations (for example, by the
central control unit 15 or via commands received from the wire-guide system) so as to vary in real time the assignment of priority to the commands in the various reference planes. - Finally, it is clear that the steering system and method described can be advantageously implemented for controlling the movement of different underwater vehicles (for example, submarines, countermeasures of a motor-driven type, underwater drawn vehicles, etc.) presenting structural limitations of control (for example, caused by the small dimensions of the control surfaces or by the low operative speed).
Claims (17)
- A method for steering a body (10) moving underwater provided with movement control elements (13) independently actuatable for generating rotations of said body (10) about one or more of its axes, the longitudinal axis (x), the transverse axis (y), and the vertical axis (z), said method comprising the step of generating deflections (δUR, δLR, δLL and δUL) of said movement control elements (13) according to steering commands (δp, δq, δr) indicative of desired rotations about said longitudinal axis (x), transverse axis (y), and vertical axis (z),
characterized by comprising, prior to said step of generating:- verifying that said steering commands (δp, δq, δr) are compatible with structural limitations of said movement control elements (13); and- according to the result of said verification, modifying said steering commands (δp, δq, δr) on the basis of said structural limitations. - The method according to claim 1, wherein said structural limitations include a maximum end-of-travel deflection (δmax) of said movement control elements (13); and said step of modifying comprises modifying said steering commands (δp, δq, δr) so that one or more of said deflections (δUR, δLR, δLL and δUL) are less than said maximum deflection (δmax) .
- The method according to claim 1 or 2, wherein said step of modifying comprises guaranteeing a desired minimum band of rotation (δpmin, δqmin, δrmin) about one or more of said longitudinal axis (x), said transverse axis (y), and said vertical axis (z).
- The method according to claim 3, wherein said step of guaranteeing comprises guaranteeing respective desired minimum bands of rotation (δpmin, δqmin, δrmin) about each of said longitudinal axis (x), said transverse axis (y), and said vertical axis (z); further comprising the step of modifying, during control of said movement, the value of said desired minimum bands of rotation (δpmin, δqmin, δrmin) according to a priority of control of the movement about said longitudinal axis (x), said transverse axis (y), and said vertical axis (z).
- The method according to any one of claims 2-4, wherein said steering commands (δp, δq, δr) include a roll steering command (δp), a pitch steering command (δq), and a yaw steering command (δr); said step of verifying comprises verifying that the sum of deflection contributions due to said pitch (δq) and yaw (δr) steering commands is lower than said maximum deflection (δmax) ; and said step of modifying comprises, if said sum exceeds said maximum deflection (δmax) , the step of limiting said pitch (δq) and yaw (δr) steering commands.
- The method according to claim 5, wherein said step of limiting comprises: if the sum of the absolute values of said pitch (δq) and yaw (δr) steering commands is not less than said maximum deflection (δmax) , and also said pitch (δq) and yaw (δr) steering commands are, in absolute value, not less than a respective desired minimum band of rotation (δqmin, δrmin) about a respective one of said transverse axis (y) and said vertical axis (z), the step of limiting said pitch (δq) and yaw (δr) steering commands to the value of said respective desired minimum band of rotation (δqmin, δrmin) ; and, if a first one of said pitch (δq) and yaw (δr) steering commands is, in absolute value, less than the respective desired minimum band of rotation (δqmin, δrmin) , the step of setting the second of said pitch (δq) and yaw (δr) steering commands equal to said maximum deflection (δmax) reduced by the absolute value of the first one of said pitch (δq) and yaw (δr) steering commands.
- The method according to claim 5 or 6, wherein said step of modifying further comprises determining a residual band of rotation (δσ) for control of the rotation about said longitudinal axis (x), as a function of said maximum deflection (δmax) and of said pitch (δq) and yaw (δr) steering commands, possibly limited.
- The method according to claim 7, wherein said step of modifying further comprises: if said residual band of rotation (δσ) is not higher than said roll steering command (δp) and than a desired minimum band of rotation (δpmin) about said longitudinal axis (x), the step of limiting said pitch (δq) and yaw (δr) steering commands on the basis of a scaling coefficient (ksc), which is a function of said residual band of rotation (δσ) and of said roll steering command (δp) .
- The method according to any one of the preceding claims, wherein said movement control elements include four rudders (13) arranged in butterfly fashion, and said step of generating deflections comprises determining deflections (δUR, δLR, δLL and δUL) of said rudders (13) according to the steering commands (δp, δq, δr), possibly modified by said step of modifying.
- The method according to any one of the preceding claims, wherein said structural limitations correspond to dimensional limitations of moving control surfaces of said movement control elements (13).
- A system (11) for steering a body (10) moving underwater, comprising movement control elements (13) actuatable independently for generating rotations of said body (2) about one or more of its axes, the longitudinal axis (x), the transverse axis (y), and the vertical axis (z), characterized by comprising a control unit (15) configured so as to implement the steering method according to any one of the preceding claims.
- The system according to claim 11, wherein said movement control elements (13) are four in number.
- The system according to claim 11 or 12, wherein said control unit (15) comprises a processing unit provided with a software module including instructions such as to implement said steering method.
- The system according to any one of claims 11-13, further comprising actuator means (14), which are operatively coupled to said movement control elements (13) and which can be actuated by said control unit (15) for generating said deflections (δUR, δLR, δLL and δUL) of said movement control elements (13).
- A computer program product, comprising software instructions capable of implementing, when run in a control unit (15) of the steering system (10) according to any one of claims 11-14, the steering method according to any one of claims 1-10.
- An underwater vehicle (10), characterized by comprising a steering system (11) according to any one of claims 11-14.
- The underwater vehicle according to claim 16, of a self-propelled, guided, or drawn type, chosen in the group comprising: a torpedo, a submarine, and an underwater countermeasure.
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
DE602008004737T DE602008004737D1 (en) | 2008-04-03 | 2008-04-03 | Method and system for controlling a body moving in a liquid |
EP08425219A EP2107333B1 (en) | 2008-04-03 | 2008-04-03 | Method and system for steering a body moving within a fluid |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP08425219A EP2107333B1 (en) | 2008-04-03 | 2008-04-03 | Method and system for steering a body moving within a fluid |
Publications (2)
Publication Number | Publication Date |
---|---|
EP2107333A1 true EP2107333A1 (en) | 2009-10-07 |
EP2107333B1 EP2107333B1 (en) | 2011-01-26 |
Family
ID=39789526
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP08425219A Active EP2107333B1 (en) | 2008-04-03 | 2008-04-03 | Method and system for steering a body moving within a fluid |
Country Status (2)
Country | Link |
---|---|
EP (1) | EP2107333B1 (en) |
DE (1) | DE602008004737D1 (en) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013173436A (en) * | 2012-02-24 | 2013-09-05 | Mitsubishi Heavy Ind Ltd | Control device, control method of control device, and underwater sailing body |
JP2016088348A (en) * | 2014-11-06 | 2016-05-23 | 三菱重工業株式会社 | Rudder controller, underwater vehicle and rudder control method |
DE102016006933B3 (en) * | 2016-06-10 | 2017-11-16 | Thyssenkrupp Ag | Method for compensating the blockage of a rudder blade in an X-rudder |
CN112591059A (en) * | 2020-12-01 | 2021-04-02 | 中国科学院深圳先进技术研究院 | Underwater vehicle control method and device |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3818853A (en) * | 1971-01-18 | 1974-06-25 | Ministre Defense Nat | Stop members in ships |
JPH06341852A (en) * | 1993-06-01 | 1994-12-13 | Ishikawajima Harima Heavy Ind Co Ltd | Underwater navigation body and its attitude control method |
GB2405125A (en) * | 2003-08-22 | 2005-02-23 | Ian Charles Holmes | Steering for coupled submersible vessels |
-
2008
- 2008-04-03 DE DE602008004737T patent/DE602008004737D1/en active Active
- 2008-04-03 EP EP08425219A patent/EP2107333B1/en active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3818853A (en) * | 1971-01-18 | 1974-06-25 | Ministre Defense Nat | Stop members in ships |
JPH06341852A (en) * | 1993-06-01 | 1994-12-13 | Ishikawajima Harima Heavy Ind Co Ltd | Underwater navigation body and its attitude control method |
GB2405125A (en) * | 2003-08-22 | 2005-02-23 | Ian Charles Holmes | Steering for coupled submersible vessels |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2013173436A (en) * | 2012-02-24 | 2013-09-05 | Mitsubishi Heavy Ind Ltd | Control device, control method of control device, and underwater sailing body |
JP2016088348A (en) * | 2014-11-06 | 2016-05-23 | 三菱重工業株式会社 | Rudder controller, underwater vehicle and rudder control method |
DE102016006933B3 (en) * | 2016-06-10 | 2017-11-16 | Thyssenkrupp Ag | Method for compensating the blockage of a rudder blade in an X-rudder |
CN112591059A (en) * | 2020-12-01 | 2021-04-02 | 中国科学院深圳先进技术研究院 | Underwater vehicle control method and device |
CN112591059B (en) * | 2020-12-01 | 2022-02-08 | 中国科学院深圳先进技术研究院 | Underwater vehicle control method |
Also Published As
Publication number | Publication date |
---|---|
EP2107333B1 (en) | 2011-01-26 |
DE602008004737D1 (en) | 2011-03-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Wang et al. | Integrated relative position and attitude control for spacecraft rendezvous with ISS and finite-time convergence | |
EP2107333B1 (en) | Method and system for steering a body moving within a fluid | |
Stepanyan et al. | Adaptive control with reference model modification | |
CN110727198B (en) | Fault-tolerant control method for missile multi-drive-state actuating mechanism faults | |
EP3004791B1 (en) | Rocket vehicle with integrated attitude control and thrust vectoring | |
US8800913B2 (en) | Methods and apparatus for a tandem divert and attitude control system | |
CN113110539B (en) | Control method and control device for bullet/arrow three channels based on duck rudder | |
Pyrkin et al. | Output controller for quadcopters with wind disturbance cancellation | |
Breivik | A ship heading and speed control concept inherently satisfying actuator constraints | |
Feng et al. | Control allocation algorithm for over-actuated electric vehicles | |
JPH05108157A (en) | Method for combining control-fin command | |
Chen et al. | Output constrained adaptive neural control for generic hypersonic vehicles suffering from non-affine aerodynamic characteristics and stochastic disturbances | |
US20150375854A1 (en) | Differential steering control of electric taxi landing gear | |
CN104991446A (en) | Unmanned plane thrust direction-changing intelligent control method based on brain emotion learning | |
Xu et al. | Pulse-width pulse-frequency based optimal controller design for kinetic kill vehicle attitude tracking control | |
Tomashevich et al. | Passification based simple adaptive control of quadrotor attitude: Algorithms and testbed results | |
CN116500890A (en) | Hovercraft filtering backstepping track tracking control method based on RLESO | |
Shen et al. | Study on vehicle chassis control integration based on a main-loop-inner-loop design approach | |
Ahmad et al. | Control allocation with actuator dynamics for aircraft flight controls | |
Mizumoto et al. | Simple adaptive control system design for a quadrotor with an internal PFC | |
Yang et al. | Development and control of four-wheel independent driving and modular steering electric vehicles for improved maneuverability limits | |
CN108490808A (en) | A kind of aircraft Configuration design method based on control distribution technique | |
CN114545816A (en) | Fault-tolerant control method for electric steering engine | |
KR101695524B1 (en) | Apparatus and method for controlling cluster of control moment gyroscope | |
Crespo et al. | Design of a model reference adaptive controller for an unmanned air vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HR HU IE IS IT LI LT LU LV MC MT NL NO PL PT RO SE SI SK TR |
|
AX | Request for extension of the european patent |
Extension state: AL BA MK RS |
|
17P | Request for examination filed |
Effective date: 20091015 |
|
17Q | First examination report despatched |
Effective date: 20100426 |
|
AKX | Designation fees paid |
Designated state(s): DE FR GB IT |
|
GRAP | Despatch of communication of intention to grant a patent |
Free format text: ORIGINAL CODE: EPIDOSNIGR1 |
|
GRAS | Grant fee paid |
Free format text: ORIGINAL CODE: EPIDOSNIGR3 |
|
GRAA | (expected) grant |
Free format text: ORIGINAL CODE: 0009210 |
|
AK | Designated contracting states |
Kind code of ref document: B1 Designated state(s): DE FR GB IT |
|
REG | Reference to a national code |
Ref country code: GB Ref legal event code: FG4D |
|
REF | Corresponds to: |
Ref document number: 602008004737 Country of ref document: DE Date of ref document: 20110310 Kind code of ref document: P |
|
REG | Reference to a national code |
Ref country code: DE Ref legal event code: R096 Ref document number: 602008004737 Country of ref document: DE Effective date: 20110310 |
|
PLBE | No opposition filed within time limit |
Free format text: ORIGINAL CODE: 0009261 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: NO OPPOSITION FILED WITHIN TIME LIMIT |
|
26N | No opposition filed |
Effective date: 20111027 |
|
REG | Reference to a national code |
Ref country code: DE Ref legal event code: R097 Ref document number: 602008004737 Country of ref document: DE Effective date: 20111027 |
|
REG | Reference to a national code |
Ref country code: DE Ref legal event code: R082 Ref document number: 602008004737 Country of ref document: DE Representative=s name: TER MEER STEINMEISTER & PARTNER GBR PATENTANWA, DE |
|
REG | Reference to a national code |
Ref country code: DE Ref legal event code: R081 Ref document number: 602008004737 Country of ref document: DE Owner name: WHITEHEAD SISTEMI SUBACQUEI S.P.A., IT Free format text: FORMER OWNER: WHITEHEAD ALENIA SISTEMI SUBACQUEI S.P.A., LIVORNO, IT Effective date: 20130325 Ref country code: DE Ref legal event code: R082 Ref document number: 602008004737 Country of ref document: DE Representative=s name: TER MEER STEINMEISTER & PARTNER PATENTANWAELTE, DE Effective date: 20130325 |
|
REG | Reference to a national code |
Ref country code: FR Ref legal event code: CA Effective date: 20130422 Ref country code: FR Ref legal event code: CD Owner name: WHITEHEAD SISTEMI SUBACQUEI S.P.A., IT Effective date: 20130422 |
|
REG | Reference to a national code |
Ref country code: FR Ref legal event code: PLFP Year of fee payment: 9 |
|
REG | Reference to a national code |
Ref country code: FR Ref legal event code: PLFP Year of fee payment: 10 |
|
REG | Reference to a national code |
Ref country code: FR Ref legal event code: PLFP Year of fee payment: 11 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: GB Payment date: 20240423 Year of fee payment: 17 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: DE Payment date: 20240429 Year of fee payment: 17 |
|
PGFP | Annual fee paid to national office [announced via postgrant information from national office to epo] |
Ref country code: IT Payment date: 20240408 Year of fee payment: 17 Ref country code: FR Payment date: 20240430 Year of fee payment: 17 |
|
REG | Reference to a national code |
Ref country code: DE Ref legal event code: R081 Ref document number: 602008004737 Country of ref document: DE Owner name: LEONARDO S.P.A., IT Free format text: FORMER OWNER: WHITEHEAD SISTEMI SUBACQUEI S.P.A., LIVORNO, IT |
|
REG | Reference to a national code |
Ref country code: GB Ref legal event code: 732E Free format text: REGISTERED BETWEEN 20240822 AND 20240828 |