Depth control method for underwater vehicle
By configuring the heavy floating center position and using the PID algorithm for depth control, the use of additional devices in the fixed depth control of underwater vehicles is solved, and low-cost fixed depth control is achieved, and design costs are reduced.
Patent Information
- Application Number
- CN202211037693.2
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-08-26
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2042-08-26
AI Technical Summary
Existing methods of fixed depth control of underwater vehicles require additional buoyancy adjustment, center of gravity adjustment and fin rudder installation, resulting in increased design costs and layout complexity.
By configuring the heavy floating center position before diving, determining the dive angle based on the expected dive speed and thrust, calculating the pitch angle of the aircraft when it is stationary in water, and configuring the heavy floating center position based on the pitch angle, obtaining the fixed depth control amount in real time. The PID algorithm is used for deep control, avoiding the use of additional devices.
The fixed-depth control of underwater vehicles is realized, which reduces the design cost, especially the development cost of the fixed-depth control system, and avoids the use of buoyancy adjustment, center of gravity adjustment and the use of fin rudder devices.
Smart Images

Figure CN115421485B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of underwater vehicle motion control, and relates to a method for underwater vehicle depth control, and in particular to a low-cost method for underwater vehicle depth control. The method is particularly suitable for depth control of torpedo-type underwater vehicles. Such underwater vehicles are generally slender and have a thruster installed at the tail to provide thrust, and have a main forward direction. Background Art
[0002] Depth control of underwater vehicles is an important part of motion control and the basis for achieving tasks such as depth control cruising and formation control.
[0003] At present, the commonly used depth control methods for underwater vehicles include buoyancy adjustment method, center of gravity adjustment method and fin-rudder method. Among them, the buoyancy adjustment method uses the buoyancy adjustment device of the underwater vehicle to adjust the displacement volume of the underwater vehicle to adjust the buoyancy, and cooperates with gravity to form a positive, negative or zero buoyancy state of the entire vehicle, thereby achieving buoyancy, diving or hovering; the center of gravity adjustment method uses the center of gravity adjustment device inside the underwater vehicle to adjust the center of gravity position to change the pitch attitude of the underwater vehicle, and then achieve buoyancy or diving under the action of thrust and hydrodynamic force; the fin-rudder method uses the steering gear inside the underwater vehicle to control the fin surface or rudder surface outside the vehicle, and changes the attitude of the underwater vehicle through the attitude control force generated by the fin surface or rudder surface during navigation, thereby achieving buoyancy or diving under the action of thrust and hydrodynamic force.
[0004] The above method is mature and has been fully verified. The relevant patents include: CN113277046A, a depth control method for a manta ray-like underwater vehicle based on the center of mass and the tail fin, in which a center of gravity adjustment device (center of mass adjustment block) is installed inside the manta ray-like vehicle, and the tail fin is used as a rudder surface, and the center of gravity adjustment method and the fin rudder method are adopted to realize the depth control of the underwater vehicle; CN113126633A, a zero-attack angle-fixed depth navigation control method for a light and long-range AUV, which comprehensively utilizes the buoyancy adjustment method, the center of gravity adjustment method and the fin rudder method to realize the depth control of a light and long-range underwater vehicle.
[0005] However, the above-mentioned depth control methods all require the underwater vehicle to be equipped with additional devices (such as buoyancy adjustment devices, center of gravity adjustment devices or fin rudders, etc.) to assist in control, which not only occupies the space inside the underwater vehicle cabin and brings difficulties to the overall layout, but also increases the design and development cost of the underwater vehicle, especially the underwater vehicle motion control system. Summary of the invention
[0006] The present invention aims to solve at least one of the technical problems existing in the prior art.
[0007] To this end, the present invention provides a depth control method for an underwater vehicle.
[0008] The technical solution of the present invention is as follows:
[0009] According to one aspect, a method for controlling the depth of an underwater vehicle is provided, the method comprising:
[0010] S10. Before diving, configure the center of gravity position, including:
[0011] S11, determining a diving angle according to a desired diving speed and an allowable thrust;
[0012] S12, determining the pitch angle of the vehicle when it is stationary in water according to the diving angle;
[0013] S13, configuring the position of the center of gravity of the vehicle based on the pitch angle;
[0014] S20, based on step S10, obtaining the depth control value of the vehicle when it is underwater in real time;
[0015] S30. Control the depth of the vehicle based on the fixed depth control amount.
[0016] Further, determining the diving angle according to the expected diving speed and the allowable thrust includes:
[0017] 1) Calculate the diving angle according to the expected diving speed;
[0018] 2) Check the diving angle obtained in step 1) according to the allowable thrust and the initial gravity and buoyancy configuration of the spacecraft. If the check is successful, go to step 3); otherwise, go to step 4);
[0019] 3) If the diving angle obtained in step 1) meets the requirements, go to step S12; if the verification is unsuccessful,
[0020] 4) If the diving angle obtained in step 1) does not meet the requirements, adjust the thrust or buoyancy to make the verification result successful. If the thrust or buoyancy cannot be adjusted, go to step 1) to adjust the expected diving speed and recalculate the diving angle on this basis.
[0021] Furthermore, the diving angle is calculated according to the expected diving speed by the following formula:
[0022]
[0023] Among them, V H is the expected diving speed; V cruise is the cruising speed; θ H is the expected diving angle. When the vehicle has a diving speed, the diving angle is negative.
[0024] Further, in step 2), if the diving angle satisfies -T 推 sinθ H >k(BG), the calibration is considered successful; k is the compensation coefficient; T 推 is the allowable thrust; G and B are the gravity and buoyancy of the underwater vehicle respectively.
[0025] Furthermore, the pitch angle of the vehicle when it is stationary in water is obtained according to the diving angle by the following formula:
[0026]
[0027] Where θ0 is the pitch angle of the vehicle when it is stationary in the water; j is the compensation coefficient; l TG is the moment arm of the thrust torque generated by the propeller relative to the center of gravity; l BG is the arm of the buoyancy moment relative to the center of gravity generated by the buoyancy of the craft, and
[0028] Furthermore, the position of the center of gravity of the vehicle is configured based on the pitch angle by the following formula:
[0029] x B -x G =tanθ0(y B -y G );
[0030] Among them, (x G ,y G ) is the position of the center of gravity of the spacecraft, (x B ,y B ) is the position of the vehicle's center of buoyancy.
[0031] Furthermore, the real-time acquisition of the depth control value of the vehicle when it is underwater includes:
[0032] Obtain the current depth deviation and the corresponding depth deviation change rate according to the current depth of the spacecraft and the reference depth set for the mission;
[0033] A PID algorithm is used to calculate the fixed depth control amount based on the depth deviation change rate.
[0034] Furthermore, the current depth deviation is obtained according to the current depth of the spacecraft and the reference depth set for the mission through the following formula:
[0035] e H (t) = H(t) - H c (t)
[0036] Differentiate the depth deviation and get the depth deviation change rate:
[0037]
[0038] Among them, e H (t) is the depth deviation at the current moment; H(t) is the current depth of the spacecraft; H c (t) is the reference depth set for the task; t is the current moment; T is the control period; t-1 is the previous moment; ΔH(t) is the depth deviation change rate.
[0039] Furthermore, the fixed depth control amount is obtained by the following formula:
[0040]
[0041] Among them, u is the fixed depth control quantity; K p , K i , K d are the proportional coefficient, integral coefficient and differential coefficient respectively.
[0042] Further, controlling the depth of the vehicle based on the fixed depth control amount specifically includes:
[0043] The thruster action amount ω is calculated according to the fixed depth control amount: ω=f(u);
[0044] The thruster rotation is controlled according to the calculated thruster action amount to achieve control of the depth of the spacecraft.
[0045] Furthermore, in step S30, once ω<0 occurs, ω=0 is forced.
[0046] Furthermore, the underwater vehicle adopts a torpedo configuration, is propelled by a single propeller, and is not equipped with a fin rudder, a center of gravity adjustment device, and a buoyancy adjustment device.
[0047] According to another aspect, a computer device is provided, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the above method when executing the computer program.
[0048] The above technical solution configures the position of the center of gravity and buoyancy before diving, so that the thrust of the vehicle has a component in the depth direction when it is underwater. There is no need to install additional buoyancy adjustment, center of gravity adjustment, fin rudder and other depth control devices. It only needs to use the component of thrust in the depth direction to cooperate with the positive buoyancy to form a combined force of floating or diving in the depth direction, thereby realizing the depth control of the vehicle. It can be seen that the underwater vehicle depth control method proposed by the present invention avoids the use of buoyancy adjustment, center of gravity adjustment and fin rudder devices, and reduces the design cost of underwater vehicles, especially the design and development cost of depth control systems. BRIEF DESCRIPTION OF THE DRAWINGS
[0049] The included drawings are used to provide a further understanding of the embodiments of the present invention, which constitute a part of the specification, are used to illustrate the embodiments of the present invention, and together with the text description, explain the principles of the present invention. Obviously, the drawings in the following description are only some embodiments of the present invention, and for ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0050] Figure 1 A schematic diagram of a longitudinal plane body coordinate system of an aircraft provided in an embodiment of the present invention;
[0051] Figure 2 A schematic diagram of a force analysis of a spacecraft provided in an embodiment of the present invention;
[0052] Figure 3 A flow chart of a low-cost depth control method provided by an embodiment of the present invention;
[0053] Figure 4 A schematic diagram of a typical torpedo-like underwater vehicle provided in an embodiment of the present invention;
[0054] Figure 5 A depth change diagram of low-cost fixed depth control provided by an embodiment of the present invention. DETAILED DESCRIPTION
[0055] It should be noted that, in the absence of conflict, the embodiments in this application and the features in the embodiments can be combined with each other. The technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. The following description of at least one exemplary embodiment is actually only illustrative and is by no means intended to limit the present invention and its application or use. Based on the embodiments in the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0056] It should be noted that the terms used herein are only for describing specific embodiments and are not intended to limit the exemplary embodiments according to the present application. As used herein, unless the context clearly indicates otherwise, the singular form is also intended to include the plural form. In addition, it should be understood that when the terms "comprise" and / or "include" are used in this specification, it indicates the presence of features, steps, operations, devices, components and / or combinations thereof.
[0057] Unless otherwise specifically stated, the relative arrangement of the parts and steps described in these embodiments, numerical expressions and numerical values do not limit the scope of the present invention. At the same time, it should be understood that, for ease of description, the sizes of the various parts shown in the accompanying drawings are not drawn according to the actual proportional relationship. The technology, method and equipment known to ordinary technicians in the relevant field may not be discussed in detail, but in appropriate cases, the technology, method and equipment should be regarded as a part of the authorization specification. In all examples shown and discussed here, any specific value should be interpreted as being merely exemplary, rather than as a limitation. Therefore, other examples of exemplary embodiments may have different values. It should be noted that similar reference numerals and letters represent similar items in the following drawings, so once a certain item is defined in an accompanying drawing, it does not need to be further discussed in subsequent drawings.
[0058] like Figure 1-3 As shown, in one embodiment of the present invention, a method for controlling the depth of an underwater vehicle is provided, the method comprising:
[0059] S10. Before diving, configure the center of gravity position, including:
[0060] S11, determining a diving angle according to a desired diving speed and an allowable thrust;
[0061] S12, determining the pitch angle of the vehicle when it is stationary in water according to the diving angle;
[0062] S13, configuring the position of the center of gravity of the vehicle based on the pitch angle;
[0063] S20, based on step S10, obtaining the depth control value of the vehicle when it is underwater in real time;
[0064] S30. Control the depth of the vehicle based on the fixed depth control amount.
[0065] In the embodiment of the present invention, the underwater vehicle may adopt a torpedo configuration, which is propelled by a single propeller and is not equipped with a fin rudder, a center of gravity adjustment device, and a buoyancy adjustment device.
[0066] By applying the above configuration, the position of the center of gravity and buoyancy is configured before diving, so that the thrust of the vehicle when it is underwater has a component in the depth direction. There is no need to install additional buoyancy adjustment, center of gravity adjustment, fin rudder and other depth control devices. It is only necessary to use the component of the thrust in the depth direction to cooperate with the positive buoyancy to form a combined force of floating or diving in the depth direction, thereby realizing the depth control of the vehicle. It can be seen that the depth control method for underwater vehicles proposed by the present invention avoids the use of buoyancy adjustment, center of gravity adjustment and fin rudder devices, and reduces the design cost of underwater vehicles, especially the design and development cost of depth control systems.
[0067] The implementation of the method described in the embodiment of the present invention is based on the reasonable configuration of the positive buoyancy, thrust size and gravity and buoyancy center position of the underwater vehicle. After completing the configuration according to the method of the embodiment of the present invention, the thrust size can be controlled by writing a control algorithm to adjust the resultant force in the depth direction, thereby realizing depth control. Among them, when diving, the thrust of the vehicle is increased. Since the thrust line is located above the center of gravity, the head-lowering torque generated by the thrust causes the vehicle to lower its head, and the thrust component in the depth direction and the resultant force of gravity overcome the buoyancy and hydrodynamic lift components. The resultant force of the vehicle in the depth direction is downward, and the vehicle dives; when floating, the thrust is reduced, and the resultant force of the thrust component in the depth direction and gravity cannot overcome the buoyancy and hydrodynamic lift. The resultant force of the vehicle in the depth direction is upward, and the vehicle floats; when the thrust of the vehicle is moderate and the resultant force in the depth direction is zero, the vehicle maintains constant depth navigation.
[0068] For the purpose of clear description, the longitudinal plane coordinate system OX of the aircraft is established. b Y b ,like Figure 1 As shown. b The axis coincides with the longitudinal axis of the aircraft, with the direction pointing to the head of the aircraft as the positive direction; OY b The axis passes through the center of gravity of the aircraft (assuming that the center of gravity of the aircraft is in the longitudinal symmetry plane) and the longitudinal axis OX of the aircraft in the longitudinal symmetry plane of the aircraft. b Vertical, with the upward direction as the positive direction, OX b Axis and OY b The intersection of the axes is taken as the origin O of the coordinate system. Figure 1 In the figure, the dashed line aa' represents the longitudinal axis of the aircraft, and the dashed line bb' represents the vertical axis passing through the center of gravity of the aircraft in the longitudinal symmetry plane of the aircraft. The gravity of the aircraft is G, the black solid square represents the position of the center of gravity of the aircraft, and the coordinate (x G ,y G ), the buoyancy is B, the black solid circle represents the position of the center of buoyancy of the spacecraft, and the coordinate (x B ,y B ). The angle between the longitudinal axis of the aircraft and the horizontal plane is defined as the pitch angle Looking up is positive, looking down is negative.
[0069] Taking the dive of a spacecraft as an example, the force analysis of the spacecraft is carried out, such as Figure 2 As shown. The underwater vehicle is subject to gravity G, acting on the center of gravity, vertically downward, and buoyancy B, acting on the center of buoyancy, vertically upward. The thrust T generated by the propeller 推 , with the center of gravity of the spacecraft as the point of action, the thrust produces a thrust moment, and the lever arm is recorded as l TG When the center of buoyancy and the center of gravity are not located on the plumb line at the same time, a buoyancy moment is generated, and the lever arm During navigation, hydrodynamic forces such as hydrodynamic resistance and lift will be generated in the direction of speed, as shown by L and D in the figure.
[0070] In the above embodiment, in order to accurately obtain the diving angle, the step of determining the diving angle according to the expected diving speed and the allowable thrust includes:
[0071] 1) Calculate the diving angle according to the expected diving speed;
[0072] 2) Check the diving angle obtained in step 1) according to the allowable thrust and the initial gravity and buoyancy configuration of the spacecraft. If the check is successful, go to step 3); otherwise, go to step 4);
[0073] 3) If the diving angle obtained in step 1) meets the requirement, go to step S12; if the verification is unsuccessful;
[0074] 4) If the diving angle obtained in step 1) does not meet the requirements, adjust the thrust or buoyancy to make the verification result successful. If the thrust or buoyancy cannot be adjusted (such as due to the selection of the propeller, etc.), go to step 1) to adjust the expected diving speed and recalculate the diving angle on this basis.
[0075] In the embodiment of the present invention, the diving angle is calculated according to the expected diving speed by the following formula:
[0076]
[0077] Among them, V H is the expected diving speed; V cruise is the cruising speed; θ H is the expected diving angle. When the vehicle has a diving speed, the diving angle is negative.
[0078] In the embodiment of the present invention, in step 2), if the diving angle satisfies -T 推 sinθ H >k(BG), the calibration is considered successful; k is the compensation coefficient, which is used to compensate for the error caused by hydrodynamic lift and is generally set to 1.5 to 3; T 推 is the allowable thrust; G and B are the gravity and buoyancy of the underwater vehicle respectively.
[0079] In the method of the embodiment of the present invention, it is required that the buoyancy of the underwater vehicle is greater than the gravity, and the whole vehicle is "positive buoyancy". 推 sinθ H >k(BG) satisfies, then the diving angle θ is determined H , proceed to the next step, otherwise consider increasing thrust or reducing buoyancy. If the thrust cannot be increased due to the propeller selection or the buoyancy cannot be reduced due to the need to float, return to step 1, reduce the expected diving speed requirement, and recalculate the diving angle θ H .
[0080] According to one embodiment of the present invention, the pitch angle of the aircraft when it is stationary in water can be calculated based on the aircraft attitude control relationship and the overall parameters:
[0081]
[0082] Where θ0 is the pitch angle of the vehicle when it is stationary in the water; j is the compensation coefficient, which is the hydrodynamic moment acting on the vehicle during the compensation navigation process and can be 1.5 to 3; l TG is the moment arm of the thrust torque generated by the propeller relative to the center of gravity; l BG is the arm of the buoyancy moment relative to the center of gravity generated by the buoyancy of the craft, and
[0083] That is, first give the center of gravity and the center of buoyancy an initial value. The initial value is generated when the overall design is carried out for equipment layout. Generally, the center of gravity is taken directly below the center of buoyancy. The height difference between the center of gravity and the center of buoyancy is used to generate the buoyancy restoring moment. Among them, (x G ,y G ) is the position of the center of gravity of the spacecraft, (x B ,y B ) is the position of the spacecraft’s center of buoyancy, Calculated according to the initial value of the gravity and buoyancy center, l TG Also a known value.
[0084] In order to achieve constant depth control, the embodiment of the present invention specifically adjusts the position difference between buoyancy and gravity in the x-direction, so that the vehicle has a pitch attitude when normally sailing in the water, which facilitates depth control using thrust.
[0085] In the above embodiment, in order to better achieve the subsequent fixed depth adjustment, the position of the center of gravity and buoyancy of the vehicle is configured based on the pitch angle by the following formula:
[0086] x B -x G =tanθ0(y B -y G );
[0087] Among them, (x G ,y G ) is the position of the center of gravity of the spacecraft, (x B ,y B ) is the position of the vehicle's center of buoyancy.
[0088] For example, under the constraint of pitch angle θ0, the center of gravity and center of buoyancy of the aircraft in the present invention must satisfy the formula x B -x G =tanθ0(y B -y G), the center of gravity position can be adjusted individually according to the characteristics of the aircraft and the actual situation during specific operation (x G ,y G ), adjust the buoyancy center position (x B ,y B ) or adjust the positions of the center of gravity and the center of buoyancy at the same time, so that the center of gravity and the center of buoyancy of the spacecraft finally meet the above requirements. After completing the configuration of the center of gravity and buoyancy, the subsequent fixed depth control can be carried out on this basis, and in the subsequent fixed depth control process, there is no need to configure the position of the center of gravity and buoyancy of the spacecraft again according to the above method (that is, in the overall design stage, the center of gravity and buoyancy is designed according to the present invention, and after it is determined, the diving ability of the spacecraft is determined accordingly. If there is no need to redesign the diving ability, there is no need to reconfigure the center of gravity and buoyancy according to the method of the present invention before multiple dives).
[0089] In the above embodiment, in order to accurately obtain the depth control value, the real-time acquisition of the depth control value of the vehicle when it is underwater includes:
[0090] Obtain the current depth deviation and the corresponding depth deviation change rate according to the current depth of the spacecraft and the reference depth set for the mission;
[0091] A PID algorithm is used to calculate the fixed depth control amount based on the depth deviation change rate.
[0092] In the embodiment of the present invention, the depth deviation at the current moment is obtained according to the current depth of the aircraft and the reference depth set for the mission by the following formula:
[0093] e H (t) = H(t) - H c (t)
[0094] Differentiate the depth deviation and get the depth deviation change rate:
[0095]
[0096] Among them, e H (t) is the depth deviation at the current moment; e H (t-1) is the depth deviation at the previous moment; H(t) is the current depth of the spacecraft, which is negative when it is downward; H c (t) is the reference depth set for the task; t is the current moment; T is the control period; t-1 is the previous moment; ΔH(t) is the depth deviation change rate at the current moment, and ΔH(t-1) is the depth deviation change rate at the previous moment.
[0097] In the embodiment of the present invention, the fixed depth control amount is obtained by the following formula:
[0098]
[0099] Among them, u is the fixed depth control quantity; K p , K i , K d are the proportional coefficient, integral coefficient and differential coefficient respectively.
[0100] Preferably, according to the allowable capacity of the propeller [u min ,u max ] Limit the control amount:
[0101]
[0102] In the above embodiment, in order to achieve fixed depth control, the depth of the vehicle is controlled based on the fixed depth control amount, specifically including:
[0103] The thruster action amount ω is calculated according to the fixed depth control amount: ω=f(u);
[0104] The thruster rotation is controlled according to the calculated thruster action amount to achieve control of the depth of the spacecraft.
[0105] For example, the specific form of the function ω=f(u) may be selected according to actual conditions.
[0106] As a specific embodiment, the propeller can be selected as a propeller, and the action amount is the propeller speed, which is directly equal to the control amount ω = f(u) = u. According to the calculated propeller speed, a speed control instruction is output to the propeller, thereby controlling the propeller rotation speed to generate different thrusts and diving speeds, thereby achieving control of the depth of the vehicle.
[0107] Preferably, in step S30, once ω<0 occurs, ω=0 is forced.
[0108] According to another embodiment, a computer device is also provided, including a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the above method when executing the computer program.
[0109] In order to have a further understanding of the underwater vehicle depth control method provided by the embodiment of the present invention, a specific embodiment is described in detail below:
[0110] like Figure 4 As shown in the figure, a certain underwater vehicle adopts a torpedo-like configuration, is propelled by a single propeller, and is not equipped with fin rudders, center of gravity adjustment devices, and buoyancy adjustment devices. Before the design was carried out, the overall parameters of the initial design of the vehicle were: the center of gravity is located on the longitudinal section, coordinates (0,-0.1), the center of buoyancy of the vehicle is located at the geometric center, coordinates (0,0), so the arm length of the buoyancy moment generated by buoyancy relative to the center of gravity can be calculated The propeller thrust line passes through the centerline of the aircraft, so the length of the arm of the thrust moment generated by the thrust relative to the center of gravity is l TG =0.1m. Before designing the depth control method, according to the cruising speed V cruise =0.5m / s requirement, the calculated cruise thrust is 88N, considering the design margin, the maximum thrust of the propeller is designed to be 1.5 times the cruise thrust: 132N. The aircraft mass is 80.8kg, the gravity is 791.84N, the buoyancy is 799.91N, and the positive buoyancy is 8.07N. Figure 3 As shown, the following steps are taken to apply the depth control method of the embodiment of the present invention, which specifically includes the following steps:
[0111] Step 1: Determine the diving angle θ according to the expected diving speed H .
[0112] According to the overall requirements, the expected diving speed V is designed. H = -0.1 m / s, so the expected diving angle θ is calculated according to formula (1): H
[0113]
[0114] Step 2: Check whether the allowable thrust meets the diving requirements
[0115] Take θ H =-11.5(°), T = 88N, k = 2, determine whether formula (2) is valid, because
[0116] -Tsinθ H =17.54>k(BG)=2×8.07=16.14 (2)
[0117] Therefore, equation (2) holds true, and the diving angle θ is determined H is -11.5°;
[0118] Step 3: Configure the center of gravity position
[0119] According to the vehicle attitude control relationship and overall parameters, θ0 is calculated, and j = 2. According to the initial design overall parameters and formula (3) The calculation results show that θ0 = -8.35°;
[0120] Furthermore, according to formula (4), B -x G =tanθ0(y B -y G) Reconfigure the center of gravity and buoyancy. In this example, since the shape of the spacecraft is relatively fixed and the buoyancy is not easy to adjust, and there is still room for adjustment of the internal counterweight, the center of gravity position is configured separately. After adjustment, the center of gravity position of the spacecraft is (0.01468,-0.1) and the center of buoyancy position is (0,0);
[0121] Step 4: Design a low-cost fixed depth controller, including:
[0122] (1) Calculate the depth deviation and depth deviation change rate: Let the current time be t, the control period be T, and the current depth of the underwater vehicle obtained by the depth sensor be H(t), which is negative when it is downward; the reference depth set for the task is H c (t), then the current depth deviation e H (t) is:
[0123] e H (t) = H(t) - H c (t)
[0124] Differentiate the depth deviation and get the depth deviation change rate:
[0125]
[0126] (2) Calculation of control quantity
[0127] Use PID algorithm to calculate the fixed depth control quantity u
[0128]
[0129] The control amount is limited according to the allowable capacity of the thruster [0,11.5]:
[0130]
[0131] (3) Calculate the thruster motion according to the control amount
[0132] According to the control quantity, the propeller action quantity ω=f(u) is calculated. Once ω<0, ω=0 is forced. In this example, the propeller is selected as a propeller, and the action quantity is the propeller speed, which is directly equal to the control quantity.
[0133] ω=f(u)=u
[0134] Based on the calculated propeller speed, a speed control instruction is output to the propeller, thereby controlling the propeller rotation speed to generate different thrust and diving speeds, thereby achieving control of the depth of the vehicle.
[0135] The effectiveness of this method is verified by simulation experiments. Figure 5As shown in the figure. At the initial moment, the vehicle depth was -1m and the expected depth was -3m. At about 90s, the vehicle's expected depth command was switched to -2m. Under the control of this method, the vehicle achieved good depth control. The large depth deviation at the beginning and around 100s was caused by the long time it took for the propeller to accelerate from zero speed to the speed required for control.
[0136] Features described and / or illustrated above for one embodiment may be used in the same or similar manner in one or more other embodiments, and / or combined with or used in place of features in other embodiments.
[0137] It should be emphasized that the term "include / comprises" when used herein refers to the presence of features, integers, steps or components, but does not exclude the presence or addition of one or more other features, integers, steps, components or combinations thereof.
[0138] The above method of the present invention can be implemented by hardware, or by hardware combined with software. The present invention relates to such a computer-readable program, which, when executed by a logic component, enables the logic component to implement the above-mentioned device or component, or enables the logic component to implement the above-mentioned various methods or steps. The present invention also relates to a storage medium for storing the above program, such as a hard disk, a magnetic disk, an optical disk, a DVD, a flash memory, etc.
[0139] The many features and advantages of these embodiments are apparent from this detailed description, and thus the appended claims are intended to cover all such features and advantages of these embodiments that fall within their true spirit and scope. Furthermore, since numerous modifications and changes will readily occur to those skilled in the art, it is not intended that the embodiments of the invention be limited to the exact construction and operation illustrated and described, but rather all suitable modifications and equivalents falling within the scope thereof are intended to be covered.
[0140] Parts of the present invention that are not described in detail are well known to those skilled in the art.
Claims
1. A method for controlling the depth of an underwater vehicle. It is characterized in that The method comprises: S10. Before diving, configure the center of gravity position, including: S11. Determine the diving angle according to the expected diving speed and the allowable thrust, including: 1) Calculate the diving angle according to the expected diving speed; 2) Check the diving angle obtained in step 1) according to the allowable thrust and the initial gravity and buoyancy configuration of the spacecraft. If the check is successful, go to step 3); otherwise, go to step 4); 3) If the diving angle obtained in step 1) meets the requirement, go to step S12; 4) If the diving angle obtained in step 1) does not meet the requirements, adjust the thrust or buoyancy to make the verification result successful. If the thrust or buoyancy cannot be adjusted, go to step 1) to adjust the expected diving speed and recalculate the diving angle on this basis; S12. Determine the pitch angle of the vehicle when it is stationary in water according to the diving angle, as shown in the following formula: Among them, θ 0 is the pitch angle of the vehicle when it is stationary in the water; j is the compensation coefficient; l TG is the moment arm of the thrust torque generated by the propeller relative to the center of gravity; l BG is the arm of the buoyancy moment relative to the center of gravity generated by the buoyancy of the craft, and (x G ,y G ) is the center of gravity of the spacecraft, (x B ,y B ) is the position of the spacecraft’s centre of buoyancy; S13, configuring the position of the center of gravity of the vehicle based on the pitch angle; S20, based on step S10, obtaining the depth control value of the vehicle when it is underwater in real time; S30. Control the depth of the vehicle based on the fixed depth control amount.
2. A method for controlling the depth of an underwater vehicle according to claim 1, It is characterized in that The dive angle is calculated based on the expected dive speed using the following formula: Among them, V H is the expected diving speed; V cruise is the cruising speed; θ H is the expected diving angle. When the vehicle has a diving speed, the diving angle is negative.
3. A method for controlling the depth of an underwater vehicle according to claim 2, It is characterized in that In step 2), if the diving angle satisfies -T 推 sinθ H >k(BG), the calibration is considered successful; k is the compensation coefficient; T 推 is the allowable thrust; G and B are the gravity and buoyancy of the underwater vehicle respectively.
4. A method for controlling the depth of an underwater vehicle according to claim 1, It is characterized in that The position of the center of gravity of the vehicle is configured based on the pitch angle by the following formula: x B -x G =tanθ 0 (y B -y G ); Among them, (x G ,y G ) is the center of gravity of the spacecraft, (x B ,y B ) is the position of the vehicle's center of buoyancy.
5. A method for controlling the depth of an underwater vehicle according to any one of claims 1 to 4, It is characterized in that The real-time acquisition of the depth control value of the underwater vehicle includes: Obtain the current depth deviation and the corresponding depth deviation change rate according to the current depth of the spacecraft and the reference depth set for the mission; A PID algorithm is used to calculate the fixed depth control amount based on the depth deviation change rate.
6. A method for controlling the depth of an underwater vehicle according to claim 5, It is characterized in that The current depth deviation is obtained according to the current depth of the spacecraft and the reference depth set by the mission through the following formula: e H (t)=H(t)-H c (t) Differentiate the depth deviation and get the depth deviation change rate: Among them, e H (t) is the depth deviation at the current moment; H(t) is the current depth of the spacecraft; H c (t) is the reference depth set for the task; t is the current moment; T is the control period; t-1 is the previous moment; ΔH(t) is the depth deviation change rate.
7. A method for controlling the depth of an underwater vehicle according to claim 6, It is characterized in that The fixed depth control value is obtained by the following formula: Among them, u is the fixed depth control quantity; K p , K i , K d are the proportional coefficient, integral coefficient and differential coefficient respectively.
8. A method for controlling the depth of an underwater vehicle according to claim 7, It is characterized in that Controlling the depth of the vehicle based on the fixed depth control amount specifically includes: The thruster action amount ω is calculated according to the fixed depth control amount: ω=f(u); The thruster rotation is controlled according to the calculated thruster action amount to achieve control of the depth of the spacecraft.
9. A method for controlling the depth of an underwater vehicle according to claim 8, It is characterized in that In step S30, once ω<0 occurs, ω=0 is forced.
10. A method for controlling the depth of an underwater vehicle according to claim 1, It is characterized in that The underwater vehicle adopts a torpedo configuration, is propelled by a single propeller, and is not equipped with a fin rudder, a center of gravity adjustment device, and a buoyancy adjustment device.
11. A computer device, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the method according to any one of claims 1 to 10 when executing the computer program.
