Control method for fixed-height flight of hydrofoil carrier, carrier and system
Through the combination of dynamic data and throttle gain instructions, the fixed-height flight control of hydrofoil vehicles is realized, solving the problems of complex operation and complex structure of the pilot in the prior art, and improving flight stability and safety.
Patent Information
- Application Number
- CN202410975373.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-19
- Publication Date
- 2024-11-12
AI Technical Summary
The existing electric hydrofoil flight control method requires the passenger to frequently adjust the center of gravity or add complex rudder surfaces and transmission systems, resulting in complex structures, increased product weight, high maintenance costs, and exhaustion of the passengers is prone to flight instability.
By obtaining the dynamic data and preset target altitude of the hydrofoil vehicle, we judge the flight status, and generate the throttle gain command based on the dynamic data and throttle instructions, we realize fine control of the throttle output and ensure that the hydrofoil vehicle is in a fixed-high flight state. Fly stably.
The hydrofoil vehicle structure is simplified, the operating burden on the passengers is reduced, the flight stability and sense of security is improved, maintenance costs are reduced, and unexpected situations are avoided due to excessive or too small throttle.
Smart Images

Figure CN118938975A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of vehicle motion state control, and specifically, to a control method, vehicle and system for a hydrofoil vehicle to fly at a constant altitude. Background Art
[0002] At present, in the general flight control of electric hydrofoil boards, the driver standing on the board needs to control the flight pitch angle of the electric hydrofoil board by adjusting his or her own center of gravity position. This method has the following disadvantages: the stable flight of the electric hydrofoil board has high requirements on the center of gravity position, and the adjustment of the center of gravity position needs to be precise, rapid and accurate, which requires the driver to have rich experience and skills; the driver needs to frequently adjust the center of gravity during the flight so that the electric hydrofoil board flies at a suitable height, which puts a heavy burden on the passengers, especially during long-term flight, which can easily cause passenger fatigue and poor experience; in the flight control of electric hydrofoil boards with control systems, the flight pitch angle of the electric hydrofoil board is generally controlled by rudders (elevators). This method has the following disadvantages: the hydrofoil board must add components such as rudders, drives, and transmission systems, which greatly increases the structural complexity and product weight of the hydrofoil board; the transmission system increases the waterproof requirements of the product; and increases additional maintenance workload and maintenance costs. Summary of the invention
[0003] The main purpose of the present application is to provide a control method, vehicle and system for a hydrofoil vehicle's constant altitude flight, so as to realize the control of the constant altitude flight state of the electric hydrofoil vehicle by controlling the throttle and power output.
[0004] In order to achieve the above-mentioned object, the present application provides: a control method for a hydrofoil vehicle to fly at a constant altitude, the method comprising:
[0005] Get the dynamic data of the current hydrofoil vehicle and the preset target height;
[0006] Output flight status judgment based on dynamic data and target altitude;
[0007] Obtain throttle commands, and output throttle gain commands based on dynamic data, flight status judgment and throttle commands;
[0008] A throttle output is generated according to the throttle command and the throttle gain command.
[0009] Further, the dynamic data includes altitude data, the method of outputting a flight state judgment according to the dynamic data and the target altitude, obtaining a throttle command, outputting a throttle gain command according to the dynamic data, the flight state judgment and the throttle command, and generating a throttle output according to the throttle command and the throttle gain command includes:
[0010] Determine whether the height data meets the preset target height, specifically:
[0011] When the altitude data meets or exceeds the target altitude, the flight status is judged as flying status.
[0012] When the altitude data is lower than the target altitude, the flight status is judged as non-flying status;
[0013] When the flight state is judged as the flight state, a throttle gain instruction is output according to the dynamic data and the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
[0014] Further, the dynamic data includes altitude data and climbing speed data, and the method of obtaining a throttle command, outputting a throttle gain command according to the dynamic data, flight state judgment and the throttle command, and generating a throttle output according to the throttle command and the throttle gain command includes:
[0015] Determine whether the height data meets the preset target height, specifically:
[0016] When the altitude data meets or exceeds the target altitude, the flight status is judged as flying status.
[0017] When the altitude data is lower than the target altitude, the flight status is judged as non-flying status;
[0018] Output climbing speed instruction according to altitude data and preset target altitude;
[0019] When the flight state is judged as the flight state, a throttle gain instruction is output according to the climb speed data and the climb speed instruction in combination with the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
[0020] Further, the dynamic data includes altitude data, climb speed data and climb acceleration data, and the method of obtaining the throttle command and outputting the throttle gain command according to the dynamic data, flight state judgment and throttle command includes:
[0021] Determine whether the height data meets the preset target height, specifically:
[0022] When the altitude data meets or exceeds the target altitude, the flight status is judged as flying status.
[0023] When the altitude data is lower than the target altitude, the flight status is judged as non-flying status;
[0024] Output climbing speed instruction according to altitude data and preset target altitude;
[0025] Outputting a climbing acceleration instruction according to the climbing speed data and the climbing speed instruction;
[0026] When the flight state is judged as the flight state, a throttle gain instruction is output according to the climb acceleration instruction and the climb acceleration data in combination with the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
[0027] Further, the dynamic data includes altitude data and flight speed data, and the method for outputting flight status judgment according to the dynamic data and the target altitude includes:
[0028] S1: Get the current throttle opening and determine whether the current throttle is greater than the minimum throttle for taking off at the target altitude. If so, jump to S2, otherwise jump to S6;
[0029] S2: According to the flight speed data, determine whether the current flight speed is greater than the minimum takeoff speed for completing the takeoff at the target altitude. If so, jump to S3, otherwise jump to S6;
[0030] S3: According to the altitude data, determine whether the current flight altitude is greater than the minimum flight altitude for taking off at the target altitude. If so, jump to S4; otherwise, jump to S6.
[0031] S4: According to the altitude data, determine whether the current flight altitude is greater than the target altitude. If so, jump to S7, otherwise jump to S5;
[0032] S5: If the target height determination timer has not been initialized, the current system time is recorded as the target height determination timer initialization time, and the process jumps to S9. If the target height determination timer has been initialized, the process calculates whether the time difference between the current system time and the target height determination timer initialization time is greater than the target height determination timing period. If so, the process jumps to S7, otherwise, the process jumps to S9.
[0033] S6: If the non-target height judgment timer is not initialized, the current system time is recorded as the non-target height judgment timer initialization time, and jump to S9. If the non-target height judgment timer is initialized, calculate whether the time difference between the current system time and the non-target height judgment timer initialization time is greater than the non-target height judgment timing period. If so, jump to S8, otherwise jump to S9;
[0034] S7: Set the flight state judgment of the hydrofoil vehicle to the flight state, set the non-target height judgment timer to the non-initialized state, and jump to S9;
[0035] S8: Set the flight state judgment of the hydrofoil vehicle to a non-flying state, set the target height judgment timer to a non-initialized state, and jump to S9;
[0036] S9: Wait for the next round of judgment.
[0037] Further, the dynamic data also includes climbing speed data, and the method of obtaining the throttle command, outputting the throttle gain command according to the dynamic data, the flight state judgment and the throttle command, and generating the throttle output according to the throttle command and the throttle gain command includes:
[0038] When the flight state is judged as the flight state, a throttle gain instruction is output according to the climb speed data and the climb speed instruction in combination with the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
[0039] Further, the dynamic data also includes climbing speed data and climbing acceleration data, and the method of obtaining a throttle command, outputting a throttle gain command according to the dynamic data, the flight state judgment and the throttle command, and generating a throttle output according to the throttle command and the throttle gain command includes:
[0040] Output climbing speed instruction according to altitude data and preset target altitude;
[0041] Outputting a climbing acceleration instruction according to the climbing speed data and the climbing speed instruction;
[0042] When the flight state is judged as the flight state, a throttle gain instruction is output according to the climb acceleration instruction and the climb acceleration data in combination with the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
[0043] Furthermore, the dynamic data also includes pitch data, and the method of obtaining a throttle command and outputting a throttle gain command according to the dynamic data, flight state judgment and the throttle command includes:
[0044] Output a target pitch angle instruction according to the altitude data and the preset target altitude;
[0045] Turn on or off the first pitch angle command according to the flight status. Specifically:
[0046] When the flight status is judged to be higher than the preset minimum take-off altitude, the first pitch angle command is turned on and output;
[0047] When the flight state is judged to be lower than a preset minimum take-off altitude, the first pitch angle command is turned off and a preset pitch angle command is output, and after taking off to a height higher than the preset minimum take-off altitude through the preset pitch angle command, the target pitch angle command is turned on and output;
[0048] Outputting a throttle command pitch angle gain according to the throttle command, the pitch data and the first pitch angle command;
[0049] A throttle gain command is output according to the throttle command and the throttle command pitch angle gain.
[0050] Further, the pitch data includes pitch angle data, pitch angle rate data and pitch angle acceleration data, and the method for outputting a throttle command pitch angle gain according to the throttle command, the pitch data and the first pitch angle command includes:
[0051] Output a pitch angle rate instruction according to the target pitch angle instruction and the pitch angle data;
[0052] Outputting a pitch angle acceleration command according to the pitch angle rate command and the pitch angle rate data;
[0053] Outputting a throttle command pitch angle acceleration gain according to the throttle command, the pitch angle acceleration command and the pitch angle acceleration data;
[0054] A throttle gain command is output according to the throttle command and the throttle command pitch angle acceleration gain.
[0055] Further, the method for generating a throttle output according to a throttle command and a throttle gain command includes:
[0056] Get the location information Tlocation of the throttle trigger;
[0057] Calculate the current maximum throttle gain command Ttri_max based on the throttle trigger position information Tlocation:
[0058] Ttri_max=Kt*Tlocation*Tcal_max,
[0059] Wherein, Kt is the preset proportional parameter, and Tcal_max is the preset maximum gain limit;
[0060] Set the throttle gain command Ttri∈(-Ttri_max, Ttri_max);
[0061] A throttle output is generated according to the throttle command and the throttle gain command.
[0062] Further, the throttle output is generated according to the throttle command and the throttle gain command, specifically:
[0063] According to the throttle command and throttle gain command, smoothing and filtering are performed according to the preset throttle curve, and throttle output is generated.
[0064] This embodiment further discloses an electric hydrofoil vehicle, comprising a carrier, a mast is arranged on the side of the carrier facing the water surface, a hydrofoil component for providing lift is arranged at the end of the mast, and a power unit for driving the hydrofoil vehicle is arranged at one end of the mast close to the hydrofoil component or connected to the hydrofoil component;
[0065] It also includes a controller, which is in communication with the power unit and is used to control the power unit to implement the above-mentioned control method for the hydrofoil vehicle to fly at a constant altitude.
[0066] This embodiment further discloses a control system for a constant altitude flight of an electric hydrofoil vehicle, the control system comprising:
[0067] Dynamic data acquisition module, used for the dynamic data of the current hydrofoil vehicle and the preset target height;
[0068] A flight status judgment module is used to output flight status judgment based on dynamic data and target altitude;
[0069] The controller module is used to obtain the throttle command and output the throttle gain command according to the dynamic data, flight status judgment and throttle command;
[0070] The throttle control module is used to generate a throttle output according to a throttle command and a throttle gain command.
[0071] This embodiment further discloses an electronic device, which includes: at least one processor and at least one memory; the memory is used to store one or more program instructions; the processor is used to run one or more program instructions to execute the above-mentioned fixed-altitude flight control method.
[0072] This embodiment further discloses a computer-readable storage medium, which includes one or more program instructions, and the one or more program instructions are used to execute the above-mentioned fixed-altitude flight control method.
[0073] Compared with the prior art, the control method, hydrofoil vehicle and system for constant altitude flight provided by the present invention have the following beneficial effects:
[0074] 1. In terms of overall control design, the throttle output is controlled by obtaining the dynamic data of the hydrofoil vehicle, so that the throttle is increased when the real-time height of the hydrofoil vehicle is lower than the setting, and the throttle is reduced when the height of the hydrofoil vehicle is higher than the setting. There is no need to set a traditional device for controlling the vehicle attitude on the hydrofoil vehicle, which makes the structure of the hydrofoil vehicle simpler and more stable during use;
[0075] 2. Before outputting the throttle control, the flight status of the designed vehicle is judged, and the throttle gain is output in combination with the further dynamic data of the hydrofoil vehicle. The throttle output can be further finely controlled based on the throttle command to avoid accidents caused by excessive or insufficient throttle due to user operation errors. BRIEF DESCRIPTION OF THE DRAWINGS
[0076] The drawings constituting a part of this application are used to provide a further understanding of this application, so that other features, purposes and advantages of this application become more obvious. The schematic embodiment drawings and their descriptions of this application are used to explain this application and do not constitute an improper limitation on this application. In the drawings:
[0077] Figure 1 This is a schematic flow chart of the control method of Example 1;
[0078] Figure 2 This is a schematic diagram of the system structure of Example 1;
[0079] Figure 3 This is a schematic diagram of the system structure of Example 2;
[0080] Figure 4 This is a schematic diagram of the system structure of Example 3;
[0081] Figure 5 This is a schematic diagram of the system structure of Example 4;
[0082] Figure 6 It is a schematic diagram of the structure of the hydrofoil vehicle;
[0083] Figure 7 This is a structural diagram of the altitude-fixed flight control system. DETAILED DESCRIPTION
[0084] In order to enable those skilled in the art to better understand the solution of the present application, the technical solution in the embodiments of the present application will be clearly and completely described below in conjunction with the drawings in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work should fall within the scope of protection of the present application.
[0085] It should be noted that the terms "first", "second", etc. in the specification of the present application and the above-mentioned drawings are used to distinguish similar objects, and are not necessarily used to describe a specific order or sequential order. It should be understood that the data used in this way can be interchanged where appropriate, so that the embodiments of the present application described here. In addition, the terms "including" and "having" and any of their variations are intended to cover non-exclusive inclusions, for example, a process, method, system, product or device comprising a series of steps or units is not necessarily limited to those steps or units clearly listed, but may include other steps or units that are not clearly listed or inherent to these processes, methods, products or devices.
[0086] In the present application, the terms "upper", "lower", "left", "right", "front", "back", "top", "bottom", "inner", "outer", "middle", "vertical", "horizontal", "lateral", "longitudinal" and the like indicate positions or positional relationships based on the positions or positional relationships shown in the drawings. These terms are mainly used to better describe the present application and its embodiments, and are not used to limit the indicated devices, elements or components to have a specific orientation, or to be constructed and operated in a specific orientation.
[0087] In addition, some of the above terms may be used to express other meanings in addition to indicating orientation or positional relationship. For example, the term "on" may also be used to express a certain dependency or connection relationship in some cases. For those of ordinary skill in the art, the specific meanings of these terms in this application can be understood according to specific circumstances.
[0088] In addition, the term "plurality" shall mean two or more.
[0089] It should be noted that, in the absence of conflict, the embodiments and features in the embodiments of the present application can be combined with each other. The present application will be described in detail below with reference to the accompanying drawings and in combination with the embodiments.
[0090] Example 1
[0091] refer to Figure 1 , Figure 2 and Figure 6 This embodiment discloses a method for controlling a hydrofoil vehicle to fly at a constant altitude, and the method specifically includes:
[0092] S100: Acquire the dynamic data of the current hydrofoil vehicle and the preset target height.
[0093] Among them, dynamic data refers to multiple data about the relationship between the hydrofoil vehicle and the water body, such as the height data and speed data of the hydrofoil vehicle. The current operating status of the hydrofoil vehicle can be known through the dynamic data, such as whether the height is lower or higher than the target height, or whether the current operation of the hydrofoil vehicle will cause its height to be lower or higher than the target height.
[0094] S200: Output flight status judgment according to dynamic data and target altitude.
[0095] Specifically, the flight state judgment refers to the relationship between the current height of the hydrofoil vehicle and the target height. When performing the flight state judgment, it can be judged that the hydrofoil vehicle meets the target height or is lower than the target height or higher than the target height, wherein the target height is a certain height or a height range. After obtaining the flight state judgment, the overall control effect of this embodiment is that when the flight state judgment is lower than the target height, it can also be understood that the lowest height of the hydrofoil vehicle is when it floats on the water surface. At this time, the user controls the throttle output of the hydrofoil vehicle to raise the height of the hydrofoil vehicle. When the flight state judgment is higher than the target height, the throttle needs to be reduced to reduce the height of the hydrofoil vehicle. In order to assist the user in performing corresponding control, this embodiment proposes to use the throttle gain for auxiliary control. It should be noted that in this embodiment, the output of the sensor used to obtain the height data is inaccurate when the hydrofoil vehicle floats on the water surface. For example, when the hydrofoil vehicle is stationary or at a low speed, it floats on the water surface. The exemplary ultrasonic sensor has no output when it is immersed in water, or it floats up and down and left and right due to the influence of waves. Therefore, in the non-flying state, the user needs to control the hydrofoil vehicle to take off to the target height. In contrast, the hydrofoil vehicle obtains lift in the water through the hydrofoil components at a certain speed, and the carrier of the hydrofoil vehicle will be lifted off the water surface so that the dynamic data of the hydrofoil vehicle is minimally affected by the waves, and the sensor can effectively output in real time, continuously and accurately. Therefore, the target height can be pre-set by the user, or it can be at least the height that the sensor can effectively output. It should be understood that when different dynamic data are obtained, the flight state judgment and control effect are also different.
[0096] This embodiment discloses that when the dynamic data is the height data of the hydrofoil vehicle, the method for judging the flight state includes:
[0097] Determine whether the height data meets the preset target height, specifically:
[0098] When the altitude data meets or exceeds the target altitude, the flight status is judged as flying status.
[0099] When the altitude data is lower than the target altitude, the flight status is judged as a non-flying status.
[0100] S300: Acquire a throttle command, and output a throttle gain command based on dynamic data, flight status judgment and the throttle command.
[0101] Among them, the throttle command is a control command input by the user in real time. Since the user has high control requirements for controlling the throttle to achieve constant altitude flight, auxiliary control is performed through the throttle gain command to achieve precise constant altitude flight control.
[0102] On the basis of step S200, the dynamic data is the height data of the hydrofoil vehicle and after obtaining the flight state judgment, the throttle command is obtained, and the method of outputting the throttle gain command according to the dynamic data, the flight state judgment and the throttle command is as follows:
[0103] S311: When the flight state is judged to be a flight state, a throttle gain instruction is output according to the dynamic data and the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to maintain the flight altitude; specifically: when the throttle instruction is too large, the throttle instruction gain is a negative gain to reduce the throttle output to maintain the altitude; when the throttle instruction is too small, the throttle instruction gain is a positive gain to increase the throttle output to maintain the altitude; when the throttle instruction is too normal, the throttle instruction gain is a zero gain to increase the throttle output to maintain the altitude.
[0104] Furthermore, when the flight state is judged as a non-flying state, the hydrofoil vehicle cannot obtain relevant accurate dynamic data, and blind gain control cannot achieve accurate control effects. Therefore, the user is required to control the throttle to adjust the flight altitude of the hydrofoil vehicle until the flight altitude meets the target altitude. At this time, the flight state judgment is automatically corrected to the flight state.
[0105] Furthermore, the priority of the throttle command input by the user must be guaranteed when the throttle is output, so that the user can feel that the throttle can be fully controlled, and the user's confidence and sense of security during use must be improved. Therefore, it is necessary to limit the generated throttle gain according to the size of the throttle command input by the user, so that the generated throttle gain will not have a significant impact on the response of the user's manual throttle adjustment, and ensure that the user can get appropriate feedback when adjusting the throttle, so that the user can feel that the throttle is always controllable. Therefore, the above throttle gain command also needs to be limited:
[0106] Get the location information Tlocation of the throttle trigger;
[0107] Calculate the current maximum throttle gain command Ttri_max based on the throttle trigger position information Tlocation:
[0108] Ttri_max=Kt*Tlocation*Tcal_max,
[0109] Wherein, Kt is the preset proportional parameter, and Tcal_max is the preset maximum gain limit;
[0110] Set the throttle gain command Ttri∈(-Ttri_max, Ttri_max).
[0111] S400: Generate a throttle output according to the throttle command and the throttle gain command.
[0112] The throttle gain command is used to directly act on the throttle command, thereby adjusting the throttle command. Specifically, the throttle command and the throttle gain command are summed to obtain the final throttle output.
[0113] To further ensure the smoothness of the throttle output, in the application, before the final throttle output, on the one hand, the user needs to feel that the throttle is sufficiently responsive to the user's operation, and on the other hand, the throttle change rate over time needs to be limited to avoid the throttle response being too drastic and causing acceleration and deceleration to be too fast, affecting the user experience and even causing safety accidents. Therefore, in this embodiment, it is also necessary to smooth and filter according to the preset throttle curve based on the throttle command and the throttle gain command, and generate the throttle output. Specifically:
[0114] Get the last throttle output Tlast, the time of the last throttle output TIMlast and the current time TIMnow;
[0115] Calculate the maximum and minimum throttle changes allowed:
[0116] The maximum throttle change range is Tmax = f (TIMnow-TIMlast),
[0117] The minimum throttle change is Tmin=-f(TIMnow-TIMlast), where f is a custom function that calculates the maximum throttle change based on a time period.
[0118] According to the throttle command Tuser input by the user, the throttle gain command Ttri and the last throttle output Tlast, the difference between the current throttle command is calculated: Tdelta = Tuser + Ttri - Tlast;
[0119] If the current throttle command difference Tdelta is less than the minimum throttle change amplitude Tmin, the current throttle command difference Tdelta is set to the minimum throttle change amplitude Tmin;
[0120] If the current throttle command difference Tdelta is greater than the maximum throttle change range Tmax, the current throttle command difference Tdelta is set to the maximum throttle change range Tmax;
[0121] Calculate the current throttle command difference with the last throttle output Tlast to obtain the current output throttle Tnow: Tnow = Tlast + Tdelta;
[0122] Set the current output throttle Tnow to Tlast.
[0123] Finally, the throttle gain instruction Ttri obtained by the above calculation and the current output throttle Tnow are summed to generate the final throttle output.
[0124] refer to Figure 6 This embodiment further discloses an electric hydrofoil vehicle, including a carrier 1, the carrier 1 is used to carry a driver, a mast 2 is provided on the side of the carrier 1 facing the water surface, a hydrofoil component 3 for providing lift is provided at the end of the mast 2, a power unit 4 for driving the hydrofoil vehicle is provided at one end of the mast 2 close to the hydrofoil component 3 or connected to the hydrofoil component 3, the power unit 4 is a blade or other structure used for underwater driving, the driving side of the power unit 4 faces the hydrofoil component 3, so as to control the movement of the carrier by driving the mast 2 to push the hydrofoil component 3. Further, the hydrofoil vehicle also includes a controller (not shown in the figure), which is in communication connection with the power unit 4 and is used to control the power unit to realize the control method of the hydrofoil vehicle fixed altitude flight as described above.
[0125] refer to Figure 2 and Figure 7 This embodiment further discloses a control system for a constant altitude flight of an electric hydrofoil vehicle, which specifically includes:
[0126] The dynamic data acquisition module acquires the dynamic data of the current hydrofoil vehicle and the preset target height. Exemplarily, the dynamic data acquisition module includes GPS and a water pressure gauge, and acquires the flight speed data of the hydrofoil vehicle through GPS, and acquires the height data of the hydrofoil vehicle through the water pressure gauge, wherein the water pressure gauge can also be replaced by a distance measuring device such as a rangefinder. In order to acquire more dynamic data, the dynamic data acquisition module is adaptively provided with more sensors.
[0127] The flight state judgment module is used to output the flight state judgment according to the dynamic data and the target height; for example, when the height data of the hydrofoil vehicle is obtained, the relationship between the height data and the target height is judged. In this embodiment, when the dynamic data is the height data of the hydrofoil vehicle, the method of flight state judgment is to judge whether the height data meets the preset target height. Specifically: when the height data meets or exceeds the target height, the flight state is judged as the flight state, and when the height data is lower than the target height, the flight state is judged as the non-flight state.
[0128] The controller module is used to obtain the throttle command and output the throttle gain command according to the dynamic data, the flight state judgment and the throttle command; in this embodiment, the controller module includes an altitude controller, and the altitude controller is used to generate the throttle gain command. For example, when the flight state is judged to be the flight state, the throttle gain command is output according to the dynamic data and the throttle command, and the throttle output is generated according to the throttle command and the throttle gain command to achieve the maintenance of the flight altitude. It is also used to respond to the user's control of the throttle in the non-flight state and adjust the flight altitude of the hydrofoil vehicle until the flight altitude meets the preset target altitude. Since the environmental factors are complex when the vehicle is in use, equipment damage and other problems may occur. Therefore, the controller module also includes an abnormal protection controller, which is used to obtain the system abnormal state. After generating the throttle output, the abnormal protection controller does not obtain the system abnormal state. If the system abnormal state is received, such as the throttle is lost, the power output will be turned off until the throttle command is restored. For another example, when the sensor and the dynamic data are received, the throttle gain command is set to zero, and only the throttle command of the user is responded. Through the above-mentioned restriction on the throttle, the safety of the user is protected when using it.
[0129] The throttle control module is used to generate a throttle output according to the throttle command and the throttle gain command. The throttle control module includes a control gain limiter and a throttle curve controller. The control gain limiter is used to output a throttle gain command according to the throttle command. Specifically, the position information Tlocation of the throttle trigger is obtained; the current maximum throttle gain command Ttri_max is calculated according to the position information Tlocation of the throttle trigger: Ttri_max=Kt*Tlocation*Tcal_max, where Kt is a preset proportional parameter and Tcal_max is a preset maximum gain limit; the throttle gain command Ttri∈(-Ttri_max, Ttri_max) is set. The throttle curve controller is used to smooth and filter the throttle command and throttle gain according to the preset throttle curve, and generate the throttle output. Specifically, the last throttle output Tlast, the time of the last throttle output TIMlast and the current time TIMnow are obtained; the maximum and minimum throttle change amplitudes allowed are calculated: the maximum throttle change amplitude is Tmax=f(TIMnow-TIMlast), and the minimum throttle change amplitude is Tmin=-f(TIMnow-TIMlast), where f is a custom function, and its function is to calculate the maximum throttle change according to the time period; according to the throttle command Tuser input by the user, the throttle gain command Ttri and the last throttle output T last calculates the current throttle command difference: Tdelta = Tuser + Ttri – Tlast; if the current throttle command difference Tdelta is less than the minimum throttle change range Tmin, the current throttle command difference Tdelta is set to the minimum throttle change range Tmin; if the current throttle command difference Tdelta is greater than the maximum throttle change range Tmax, the current throttle command difference Tdelta is set to the maximum throttle change range Tmax; the current throttle command difference is calculated with the last throttle output Tlast to obtain the current output throttle Tnow: Tnow = Tlast + Tdelta; the current output throttle Tnow is set to Tlast. Finally, the throttle gain command Ttri obtained by the above calculation and the current output throttle Tnow are summed to generate the final throttle output.
[0130] This embodiment further discloses an electronic device, which includes: at least one processor and at least one memory; the memory is used to store one or more program instructions; the processor is used to run the one or more program instructions to execute the above method.
[0131] This embodiment further discloses a computer-readable storage medium, which includes one or more program instructions, and the one or more program instructions are used to execute the above method.
[0132] Example 2
[0133] refer to Figure 2 and Figure 3 , the difference between this embodiment and embodiment 1 is that, in order to further ensure the accuracy of the output throttle gain command, in step S100: the dynamic data of the current hydrofoil vehicle and the preset target height are obtained; the dynamic data also includes the climbing speed data of the hydrofoil vehicle, and the climbing speed data is obtained by calculating the height data of the hydrofoil vehicle, or by other sensor detection methods. Then, compared with step S300 in embodiment 1: obtaining the throttle command, outputting the throttle gain command according to the dynamic data, flight state judgment and throttle command, the method in this embodiment has the following differences after obtaining the flight state judgment:
[0134] S321: Outputting a climbing speed instruction according to the altitude data and a preset target altitude;
[0135] S322: When the flight state is determined to be the flight state, a throttle gain instruction is output according to the climb speed data and the climb speed instruction in combination with the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
[0136] This embodiment further proposes an optimization scheme, that is, the dynamic data also includes climbing acceleration data, and the next dynamic of the hydrofoil vehicle can be accurately predicted through the climbing acceleration data, so the throttle command is obtained, and the throttle gain command is output according to the dynamic data, the flight state judgment and the throttle command. The method in this embodiment is further as follows after obtaining the flight state judgment:
[0137] S324: Outputting a climbing speed instruction according to the altitude data and a preset target altitude;
[0138] S325: Outputting a climbing acceleration instruction according to the climbing speed data and the climbing speed instruction;
[0139] S326: When the flight state is determined to be the flight state, a throttle gain instruction is output according to the climb acceleration instruction and the climb acceleration data in combination with the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to maintain the flight altitude.
[0140] This embodiment further differs from Embodiment 1 in that, in the control system for constant-altitude flight of the electric hydrofoil vehicle, the controller module in this embodiment also includes a climb rate controller and a climb acceleration controller. Specifically, in this embodiment, the altitude controller is used to output a climb speed instruction based on altitude data and a preset target altitude, the climb rate controller is used to output a climb acceleration instruction based on the climb rate instruction and the climb speed, and the climb acceleration controller is used to output a throttle gain instruction based on the climb acceleration instruction and the climb acceleration.
[0141] Example 3
[0142] refer to Figure 2 , Figure 4 and Figure 5 The difference between this embodiment and embodiment 1 is that, in order to further ensure the accuracy of the output throttle gain command, in step S100: the dynamic data of the current hydrofoil vehicle and the preset target height are obtained; wherein the dynamic data also includes flight speed data and pitch data. Step S200: outputting flight state judgment according to the dynamic data and the target height, the method in this embodiment specifically includes:
[0143] S1: Get the current throttle opening and determine whether the current throttle is greater than the minimum throttle for taking off at the target altitude. If so, jump to S2, otherwise jump to S6;
[0144] S2: According to the flight speed data, determine whether the current flight speed is greater than the minimum takeoff speed for completing the takeoff at the target altitude. If so, jump to S3, otherwise jump to S6;
[0145] S3: According to the altitude data, determine whether the current flight altitude is greater than the minimum flight altitude for taking off at the target altitude. If so, jump to S4; otherwise, jump to S6.
[0146] S4: According to the altitude data, determine whether the current flight altitude is greater than the target altitude. If so, jump to S7, otherwise jump to S5;
[0147] S5: If the target height determination timer has not been initialized, the current system time is recorded as the target height determination timer initialization time, and the process jumps to S9. If the target height determination timer has been initialized, the process calculates whether the time difference between the current system time and the target height determination timer initialization time is greater than the target height determination timing period. If so, the process jumps to S7, otherwise, the process jumps to S9.
[0148] S6: If the non-target height judgment timer is not initialized, the current system time is recorded as the non-target height judgment timer initialization time, and jump to S9. If the non-target height judgment timer is initialized, calculate whether the time difference between the current system time and the non-target height judgment timer initialization time is greater than the non-target height judgment timing period. If so, jump to S8, otherwise jump to S9;
[0149] S7: Set the flight state judgment of the hydrofoil vehicle to the flight state, set the non-target height judgment timer to the non-initialized state, and jump to S9;
[0150] S8: Set the flight state judgment of the hydrofoil vehicle to a non-flying state, set the target height judgment timer to a non-initialized state, and jump to S9;
[0151] S9: Wait for the next round of judgment.
[0152] On this basis, the method in this embodiment is similar to step S300 in embodiment 1: obtaining a throttle command, and outputting a throttle gain command according to dynamic data, flight state judgment and throttle command. After obtaining the flight state judgment, the method in this embodiment is further as follows:
[0153] S331: Outputting a target pitch angle instruction according to the altitude data and a preset target altitude;
[0154] S332: Turn on or off the target pitch angle command according to the flight status. Specifically:
[0155] S333: when the flight state is judged as the flight state, the target pitch angle command is turned on and output;
[0156] S334: when the flight state is determined to be a non-flight state, the target pitch angle instruction is turned off, and a preset pitch angle instruction is output, and after taking off to a height higher than a preset minimum take-off height through the preset pitch angle instruction, the target pitch angle instruction is turned on and output;
[0157] S335: Outputting a throttle command pitch angle gain according to the throttle command, the pitch data and the target pitch angle command;
[0158] S336: Output a throttle gain command according to the throttle command and the throttle command pitch angle gain.
[0159] From the above, it can be seen that introducing pitch data and preset pitch instructions in dynamic data can effectively solve the problem that the hydrofoil vehicle can only fly to the target height by the user controlling the throttle when it is not in the flying state, further improving the refined control of the flight.
[0160] Further, the present embodiment provides an example of an optimization scheme for pitch data. Specifically, the pitch data includes pitch angle data, pitch angle rate data, and pitch angle acceleration data. After obtaining the target pitch angle command, step S335: a method for outputting a throttle command pitch angle gain according to the throttle command, the pitch data, and the target pitch angle command includes:
[0161] S337: Outputting a pitch angle rate instruction according to the target pitch angle instruction and the pitch angle data;
[0162] S338: Outputting a pitch angle acceleration instruction according to the pitch angle rate instruction and the pitch angle rate data;
[0163] S339: Outputting a throttle command pitch acceleration gain according to the throttle command, the pitch acceleration command and the pitch acceleration data;
[0164] S3310: Output a throttle gain command according to the throttle command and the throttle command pitch angle acceleration gain.
[0165] The present embodiment is further different from the first embodiment in that, in the control system for the electric hydrofoil vehicle to fly at a fixed altitude, the controller module in the present embodiment further includes a pitch angle controller, a pitch angle rate controller and a pitch angle acceleration controller. Specifically, in the present embodiment, the altitude controller is used to output a target pitch angle instruction according to the altitude data and the preset target altitude, the pitch angle controller is used to output a pitch angle rate instruction according to the target pitch angle instruction and the pitch angle data, the pitch angle rate controller is used to output a pitch angle acceleration instruction according to the pitch angle rate instruction and the pitch angle rate data, and the pitch angle acceleration controller is used to output a throttle command pitch angle acceleration gain according to the pitch angle acceleration instruction and the pitch angle acceleration data. The control gain limiter is used to output a throttle gain instruction according to the throttle instruction and the throttle command pitch angle acceleration gain.
[0166] Example 4
[0167] This embodiment is another implementation method of the solution in Example 2 in which the dynamic data also includes climbing speed data or also includes climbing speed data and climbing acceleration data, based on the flight state judgment in Example 3. Specifically, when the dynamic data includes altitude data, flight speed data and climbing speed data, step S300: obtaining a throttle command, outputting a throttle gain command according to the dynamic data, the flight state judgment and the throttle command, and after obtaining the flight state judgment by the flight state judgment method in this embodiment, further comprising:
[0168] S341: When the flight state is determined to be a flight state, a throttle gain instruction is output according to the climb speed data and the climb speed instruction in combination with the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
[0169] For further reference, Figure 5 , when the dynamic data includes altitude data, flight speed data, climb speed data and climb acceleration data, step S300: obtaining a throttle command, outputting a throttle gain command according to the dynamic data, the flight state judgment and the throttle command, and further including: after obtaining the flight state judgment by the flight state judgment method in this embodiment;
[0170] S343: Outputting a climbing speed instruction according to the altitude data and a preset target altitude;
[0171] S344: Outputting a climbing acceleration instruction according to the climbing speed data and the climbing speed instruction;
[0172] S345: When the flight state is determined to be the flight state, a throttle gain instruction is output according to the climb acceleration instruction and the climb acceleration data in combination with the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
[0173] The specific manner of executing the operation of each unit in the above embodiment has been described in detail in the embodiment of the method, and will not be elaborated here.
[0174] The above are only preferred embodiments of the present application and are not intended to limit the present application. For those skilled in the art, the present application may have various modifications and variations. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present application shall be included in the protection scope of the present application.
Claims
1. A method for controlling a hydrofoil vehicle to fly at a constant altitude, characterized in that: The method comprises: Obtain the dynamic data of the current hydrofoil vehicle and the preset target altitude; Output flight status judgment based on dynamic data and target altitude; Obtain throttle commands, and output throttle gain commands based on dynamic data, flight status judgment and throttle commands; A throttle output is generated according to the throttle command and the throttle gain command.
2. The method for controlling the hydrofoil vehicle to fly at a constant altitude as claimed in claim 1, characterized in that: The dynamic data includes altitude data, the method of outputting a flight state judgment according to the dynamic data and the target altitude, obtaining a throttle command, outputting a throttle gain command according to the dynamic data, the flight state judgment and the throttle command, and generating a throttle output according to the throttle command and the throttle gain command includes: Determine whether the height data meets the preset target height, specifically: When the altitude data meets or exceeds the target altitude, the flight status is judged as flying status. When the altitude data is lower than the target altitude, the flight status is judged as non-flying status; When the flight state is judged as the flight state, a throttle gain instruction is output according to the dynamic data and the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
3. The method for controlling the hydrofoil vehicle to fly at a constant altitude as claimed in claim 1, characterized in that: The dynamic data includes altitude data and climbing speed data, and the method of obtaining a throttle command, outputting a throttle gain command according to the dynamic data, flight state judgment and the throttle command, and generating a throttle output according to the throttle command and the throttle gain command includes: Determine whether the height data meets the preset target height, specifically: When the altitude data meets or exceeds the target altitude, the flight status is judged as flying status. When the altitude data is lower than the target altitude, the flight status is judged as non-flying status; Output climbing speed instruction according to altitude data and preset target altitude; When the flight state is judged as the flight state, a throttle gain instruction is output according to the climb speed data and the climb speed instruction in combination with the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
4. The method for controlling a hydrofoil vehicle to fly at a constant altitude as claimed in claim 1, characterized in that: The dynamic data includes altitude data, climbing speed data and climbing acceleration data. The method of obtaining the throttle command and outputting the throttle gain command according to the dynamic data, flight state judgment and throttle command includes: Determine whether the altitude data meets the preset target altitude, specifically: When the altitude data meets or exceeds the target altitude, the flight status is judged as flying status. When the altitude data is lower than the target altitude, the flight status is judged as non-flying status; Output climbing speed instruction according to altitude data and preset target altitude; Outputting a climbing acceleration instruction according to the climbing speed data and the climbing speed instruction; When the flight state is judged as the flight state, a throttle gain instruction is output according to the climb acceleration instruction and the climb acceleration data in combination with the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
5. The method for controlling a hydrofoil vehicle to fly at a constant altitude as claimed in claim 1, characterized in that: The dynamic data includes altitude data and flight speed data, and the method for outputting flight status judgment according to the dynamic data and the target altitude includes: S1: Get the current throttle opening and determine whether the current throttle is greater than the minimum throttle for taking off at the target altitude. If so, jump to S2, otherwise jump to S6; S2: According to the flight speed data, determine whether the current flight speed is greater than the minimum takeoff speed for completing the takeoff at the target altitude. If so, jump to S3, otherwise jump to S6; S3: According to the altitude data, determine whether the current flight altitude is greater than the minimum flight altitude for taking off at the target altitude. If so, jump to S4; otherwise, jump to S6. S4: According to the altitude data, determine whether the current flight altitude is greater than the target altitude. If so, jump to S7, otherwise jump to S5; S5: If the target height determination timer has not been initialized, the current system time is recorded as the target height determination timer initialization time, and the process jumps to S9. If the target height determination timer has been initialized, the process calculates whether the time difference between the current system time and the target height determination timer initialization time is greater than the target height determination timing period. If so, the process jumps to S7, otherwise, the process jumps to S9. S6: If the non-target height judgment timer is not initialized, the current system time is recorded as the non-target height judgment timer initialization time, and jump to S9. If the non-target height judgment timer is initialized, calculate whether the time difference between the current system time and the non-target height judgment timer initialization time is greater than the non-target height judgment timing period. If so, jump to S8, otherwise jump to S9; S7: Set the flight state judgment of the hydrofoil vehicle to the flight state, set the non-target height judgment timer to the non-initialized state, and jump to S9; S8: Set the flight state judgment of the hydrofoil vehicle to a non-flying state, set the target height judgment timer to a non-initialized state, and jump to S9; S9: Wait for the next round of judgment.
6. The method for controlling the hydrofoil vehicle to fly at a constant altitude as claimed in claim 5, characterized in that: The dynamic data also includes climbing speed data. The method of obtaining a throttle command, outputting a throttle gain command according to the dynamic data, the flight state judgment and the throttle command, and generating a throttle output according to the throttle command and the throttle gain command includes: When the flight state is judged as the flight state, a throttle gain instruction is output according to the climb speed data and the climb speed instruction in combination with the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
7. The method for controlling a hydrofoil vehicle to fly at a constant altitude as claimed in claim 5, characterized in that: The dynamic data also includes climbing speed data and climbing acceleration data. The method of obtaining a throttle command, outputting a throttle gain command according to the dynamic data, flight state judgment and the throttle command, and generating a throttle output according to the throttle command and the throttle gain command includes: Output climbing speed instruction according to altitude data and preset target altitude; Outputting a climbing acceleration instruction according to the climbing speed data and the climbing speed instruction; When the flight state is judged as the flight state, a throttle gain instruction is output according to the climb acceleration instruction and the climb acceleration data in combination with the throttle instruction, and a throttle output is generated according to the throttle instruction and the throttle gain instruction to achieve maintaining the flight altitude.
8. The method for controlling a hydrofoil vehicle to fly at a constant altitude as claimed in claim 5, characterized in that: The dynamic data also includes pitch data. The method of obtaining a throttle command and outputting a throttle gain command according to the dynamic data, flight state judgment and the throttle command includes: Output a target pitch angle instruction according to the altitude data and the preset target altitude; Turn on or off the target pitch angle command according to the flight status. Specifically: When the flight state is judged as the flight state, the target pitch angle command is turned on and output; When the flight state is judged as a non-flying state, the target pitch angle command is turned off, and a preset pitch angle command is output, and after taking off to a height higher than a preset minimum take-off height through the preset pitch angle command, the target pitch angle command is turned on and output; Outputting a throttle command pitch angle gain according to the throttle command, pitch data and target pitch angle command; A throttle gain command is output according to the throttle command and the throttle command pitch angle gain.
9. The method for controlling a hydrofoil vehicle to fly at a constant altitude as claimed in claim 8, characterized in that: The pitch data includes pitch angle data, pitch angle rate data and pitch angle acceleration data. The method for outputting a throttle command pitch angle gain according to a throttle command, pitch data and a target pitch angle command includes: Output a pitch angle rate instruction according to the target pitch angle instruction and the pitch angle data; Outputting a pitch angle acceleration command according to the pitch angle rate command and the pitch angle rate data; Outputting a throttle command pitch acceleration gain according to the throttle command, the pitch acceleration command and the pitch acceleration data; A throttle gain command is output according to the throttle command and the throttle command pitch angle acceleration gain.
10. The method for controlling a hydrofoil vehicle to fly at a constant altitude according to any one of claims 1 to 9, characterized in that: The calculation method for generating a throttle output according to a throttle command and a throttle gain command comprises: Get the location information Tlocation of the throttle trigger; Calculate the current maximum throttle gain command Ttri_max based on the throttle trigger position information Tlocation: Ttri_max=Kt*Tlocation*Tcal_max, Wherein, Kt is the preset proportional parameter, and Tcal_max is the preset maximum gain limit; Set the throttle gain command Ttri∈(-Ttri_max, Ttri_max); A throttle output is generated according to the throttle command and the throttle gain command.
11. The method for controlling a hydrofoil vehicle to fly at a constant altitude as claimed in claim 1, characterized in that: The method for generating a throttle output according to a throttle command and a throttle gain command comprises: According to the throttle command and throttle gain command, smoothing and filtering are performed according to the preset throttle curve, and throttle output is generated.
12. An electric hydrofoil vehicle, characterized in that: The vehicle comprises a carrier, wherein a mast is arranged on the side of the carrier facing the water surface, a hydrofoil component for providing lift is arranged at the end of the mast, and a power unit for driving the hydrofoil vehicle is arranged at one end of the mast close to the hydrofoil component or connected to the hydrofoil component; It also includes a controller, which is in communication with the power unit and is used to control the power unit to implement the control method for constant-altitude flight of a hydrofoil vehicle as described in any one of claims 1-11.
13. A control system for a hydrofoil vehicle to fly at a constant altitude, characterized in that: The control system comprises: Dynamic data acquisition module, used for the dynamic data of the current hydrofoil vehicle and the preset target height; A flight status judgment module is used to output flight status judgment based on dynamic data and target altitude; The controller module is used to obtain the throttle command and output the throttle gain command according to the dynamic data, flight status judgment and throttle command; The throttle control module is used to generate a throttle output according to a throttle command and a throttle gain command.
14. An electronic device, characterized in that: The electronic device comprises: at least one processor and at least one memory; the memory is used to store one or more program instructions; the processor is used to run one or more program instructions to execute the method according to any one of claims 1-11.
15. A computer-readable storage medium, characterized in that: The computer storage medium includes one or more program instructions, and the one or more program instructions are used to execute the method according to any one of claims 1-11.
Citation Information
Cited By
Control method and system for altitude-hold flight of hydrofoil vehicle, and vehicle
WO2026016435A1
