Height-fixed flight control method based on attitude of hydrofoil carrier, carrier and system
By obtaining the attitude data and throttle instructions of the hydrofoil vehicle, the throttle gain instructions are generated, and the fixed-height flight control of the electric hydrofoil vehicle is achieved, which solves the problems of unstable flight and high maintenance costs in the existing technology, and improves flight Stability and user experience.
Patent Information
- Application Number
- CN202410975371.5
- 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 unstable flight, fatigue and high maintenance costs.
By obtaining the attitude data and preset target height of the hydrofoil vehicle, the attitude data and throttle commands are used to generate the throttle gain command, and the fixed-height flight status control of the electric hydrofoil vehicle is realized, avoiding dependence on the structure and rudder surface.
It realizes the highly stable maintenance and structural simplification of hydrofoil vehicles, reduces user operation burden, improves flight stability and user experience, and reduces maintenance costs.
Smart Images

Figure CN118938974A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the field of vehicle motion state control, and more specifically, to a control method, vehicle and system for constant altitude flight based on the attitude of a hydrofoil vehicle. 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 constant altitude flight based on the attitude of a hydrofoil vehicle, so as to control the constant altitude flight state of the electric hydrofoil vehicle by controlling the throttle power output through attitude analysis.
[0004] In order to achieve the above-mentioned purpose, the present application provides a control method for constant altitude flight based on the attitude of a hydrofoil vehicle, the method comprising:
[0005] Get the current hydrofoil vehicle's attitude data and preset target height;
[0006] Output flight status judgment based on attitude data and target altitude;
[0007] Obtain throttle command, and output throttle gain command according to attitude data, flight status judgment and throttle command;
[0008] A throttle output is generated according to the throttle command and the throttle gain command.
[0009] Further, the attitude data includes altitude data and flight speed data, and the method for outputting flight status judgment according to the attitude data and the target altitude includes:
[0010] 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;
[0011] 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;
[0012] 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.
[0013] 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;
[0014] 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.
[0015] 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;
[0016] 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;
[0017] 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;
[0018] S9: Wait for the next round of judgment.
[0019] Furthermore, the attitude data also includes pitch data, and the method of obtaining a throttle command and outputting a throttle gain command according to the attitude data, flight state judgment and the throttle command includes:
[0020] Get the preset target pitch angle command, and output the pitch angle command according to the flight status. Specifically:
[0021] When the flight state is judged to be a flight state, starting and outputting the target pitch angle instruction;
[0022] When the flight state is determined to be 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;
[0023] Outputting a throttle command pitch angle gain according to the throttle command, pitch data and target pitch angle command;
[0024] A throttle gain command is output according to the throttle command and the throttle command pitch angle gain.
[0025] Further, the pitch data includes pitch angle data and pitch angle rate data, and the method of outputting a throttle command pitch angle gain according to the throttle command, the pitch data and the target pitch angle command, and outputting a throttle gain command according to the throttle command and the throttle command pitch angle gain includes:
[0026] Output a pitch angle rate instruction according to the target pitch angle instruction and the pitch angle data;
[0027] Outputting a throttle command pitch rate gain according to the pitch rate command and the pitch rate data;
[0028] A throttle gain command is output according to the throttle command and the throttle command pitch rate gain.
[0029] Further, the pitch data includes pitch angle data, pitch angle rate data and pitch angle acceleration data, and the method of outputting a throttle command pitch angle gain according to the throttle command, the pitch data and the target pitch angle command, and outputting a throttle gain command according to the throttle command and the throttle command pitch angle gain includes:
[0030] Output a pitch angle rate instruction according to the target pitch angle instruction and the pitch angle data;
[0031] Outputting a pitch angle acceleration command according to the pitch angle rate command and the pitch angle rate data;
[0032] Outputting a throttle command pitch acceleration gain according to the throttle command, the pitch acceleration command and the pitch acceleration data;
[0033] A throttle gain command is output according to the throttle command and the throttle command pitch angle acceleration gain.
[0034] Further, the calculation method for generating the throttle output according to the throttle command and the throttle gain command includes:
[0035] Get the location information Tlocation of the throttle trigger;
[0036] According to the throttle trigger position information Tlocation, calculate the current maximum throttle gain limit Ttri_max:
[0037] Ttri_max=Kt*Tlocation*Tcal_max,
[0038] Wherein, Kt is the preset proportional parameter, and Tcal_max is the preset maximum gain limit;
[0039] Set the throttle gain command Ttri∈(-Ttri_max, Ttri_max);
[0040] A throttle output is generated according to the throttle command and the throttle gain command.
[0041] Further, the method for generating a throttle output according to a throttle command and a throttle gain command includes:
[0042] 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.
[0043] 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;
[0044] 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.
[0045] This embodiment further discloses a control system for a hydrofoil vehicle to fly at constant altitude, the control system comprising:
[0046] The attitude data acquisition module is used to obtain the attitude data of the current hydrofoil vehicle and the preset target height;
[0047] A flight status judgment module is used to output flight status judgment based on attitude data and target altitude;
[0048] The controller module obtains the throttle command and outputs the throttle gain command according to the attitude data, flight status judgment and throttle command;
[0049] The throttle control module generates a throttle output according to the throttle command and the throttle gain command.
[0050] 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 method.
[0051] This embodiment further discloses a computer-readable storage medium, wherein the computer storage medium contains one or more program instructions, and the one or more program instructions are used to execute the above method.
[0052] 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:
[0053] 1. In the overall control design, the throttle output is controlled by the attitude data of the hydrofoil vehicle, so that when the height of the hydrofoil vehicle is lower than the target height, the preset pitch command is output to complete the take-off. When the height of the hydrofoil vehicle meets the target height, the target pitch command is output, and the height of the hydrofoil vehicle is maintained in combination with the pitch data. There is no need to set a traditional device for controlling the attitude of the vehicle on the hydrofoil vehicle, which makes the structure of the hydrofoil vehicle simpler and more stable during use;
[0054] 2. The designed throttle gain limits the throttle gain through 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, ensuring that the user can get appropriate feedback when adjusting the throttle, allowing the user to feel that the throttle is always controllable. BRIEF DESCRIPTION OF THE DRAWINGS
[0055] 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:
[0056] Figure 1 This is a schematic flow chart of the control method of this embodiment;
[0057] Figure 2 Schematic diagram of the system structure of this embodiment;
[0058] Figure 3 It is a schematic diagram of the structure of the hydrofoil vehicle;
[0059] Figure 4 Schematic diagram of the structure of the altitude-fixed flight control system of this embodiment. DETAILED DESCRIPTION
[0060] 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.
[0061] 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.
[0062] 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.
[0063] 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.
[0064] In addition, the term "plurality" shall mean two or more.
[0065] 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.
[0066] refer to Figure 1 , Figure 2 and Figure 3 This embodiment discloses a method for controlling a constant altitude flight based on the attitude of a hydrofoil vehicle, and the method specifically includes:
[0067] S100: Acquire the current attitude data of the hydrofoil vehicle and the preset target height.
[0068] Among them, the attitude data are 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 attitude data, such as whether the height is lower or higher than the target height, and for example, the current operation of the hydrofoil vehicle will cause its height to be lower or higher than the target height.
[0069] S200: Output flight status judgment according to attitude data and target altitude.
[0070] Specifically, flight state judgment refers to the relationship between the current height of the hydrofoil vehicle and the target height. When performing 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 to output the flight state judgment result through the height data and flight speed data of the hydrofoil vehicle, and the specific result includes the flight state or the non-flight state. 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 bubble has no output when it is underwater, or it floats up and down and swings left and right due to the influence of waves. Therefore, in the non-flight state, it is necessary to control the hydrofoil vehicle to take off to the target height through a preset control instruction. Relatively speaking, the hydrofoil vehicle obtains lift in the water through the hydrofoil component at a certain speed, and the carrier of the hydrofoil vehicle will be lifted off the water surface so that the attitude 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 altitude can be preset by the user, or can be at least the altitude that the sensor can effectively output. It should be understood that when different attitude data are obtained, the flight state judgment and control effect are also achieved differently.
[0071] In this embodiment, after obtaining the height data and flight speed data of the hydrofoil vehicle, the method for outputting flight status judgment according to the attitude data and the target height includes:
[0072] 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;
[0073] 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;
[0074] 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.
[0075] 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;
[0076] 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.
[0077] 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;
[0078] 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;
[0079] 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;
[0080] S9: Wait for the next round of judgment.
[0081] It can be seen that through the above-mentioned flight state judgment method, various situations in which the hydrofoil vehicle has not taken off to the target altitude can be effectively judged as a non-take-off state, thereby improving the accuracy of the hydrofoil vehicle flight state judgment.
[0082] S300: Acquire a throttle command, and output a throttle gain command according to attitude data, flight status judgment and the throttle command.
[0083] Specifically, in this embodiment, the attitude data also includes pitch data. After obtaining the flight state judgment in the above step S200, a throttle command is obtained. The method of outputting a throttle gain command according to the attitude data, the flight state judgment and the throttle command includes:
[0084] S311: Outputting a target pitch angle instruction according to the altitude data and a preset target altitude;
[0085] S312: Turn on or off the target pitch angle command according to the flight status. Specifically:
[0086] S313: when the flight state is determined to be the flight state, the target pitch angle instruction is turned on and output;
[0087] S314: 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;
[0088] S315: Outputting a throttle command pitch angle gain according to the throttle command, the pitch data and the target pitch angle command;
[0089] S316: Outputting a throttle gain command according to the throttle command and the throttle command pitch angle gain.
[0090] 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.
[0091] This embodiment also discloses an optimization scheme. Specifically, the pitch data includes pitch angle data and pitch angle rate data. The above step S315: outputting a throttle command pitch angle gain according to the throttle command, the pitch data and the target pitch angle command, and the step S316: outputting a throttle gain command according to the throttle command and the throttle command pitch angle gain include:
[0092] S317: Outputting a pitch angle rate instruction according to the target pitch angle instruction and the pitch angle data;
[0093] S318: Outputting a throttle command pitch rate gain according to the pitch rate command and the pitch rate data;
[0094] S319: Outputting a throttle gain command according to the throttle command and the throttle command pitch rate gain.
[0095] Furthermore, the present embodiment again 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 S315: outputting a throttle command pitch angle gain according to the throttle command, the pitch data, and the target pitch angle command, and step S316: outputting a throttle gain command according to the throttle command and the throttle command pitch angle gain. The method includes:
[0096] S3110: Outputting a pitch angle rate instruction according to the target pitch angle instruction and the pitch angle data;
[0097] S3111: outputting a pitch acceleration instruction according to the pitch rate instruction and the pitch rate data;
[0098] S3112: Outputting a throttle command pitch acceleration gain according to the throttle command, the pitch acceleration command and the pitch acceleration data;
[0099] S3113: Output a throttle gain command according to the throttle command and the throttle command pitch angle acceleration gain.
[0100] After obtaining the throttle gain command, 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, ensuring that the user can get appropriate feedback when adjusting the throttle, allowing the user to feel that the throttle is always controllable.
[0101] Therefore, the above throttle gain command needs to be limited:
[0102] Get the location information Tlocation of the throttle trigger;
[0103] Calculate the current maximum throttle gain command Ttri_max based on the throttle trigger position information Tlocation:
[0104] Ttri_max=Kt*Tlocation*Tcal_max,
[0105] Wherein, Kt is the preset proportional parameter, and Tcal_max is the preset maximum gain limit;
[0106] Set the throttle gain command Ttri∈(-Ttri_max, Ttri_max).
[0107] The above-mentioned limiting process ensures the priority of the throttle command input by the user in the throttle output, so that the user can feel that the throttle can be fully controlled, thereby improving the user's confidence and sense of security during use.
[0108] S400: Generate a throttle output according to the throttle command and the throttle gain command.
[0109] 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.
[0110] 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:
[0111] Get the last throttle output Tlast, the time of the last throttle output TIMlast and the current time TIMnow;
[0112] Calculate the maximum and minimum throttle changes allowed:
[0113] The maximum throttle change range is Tmax = f (TIMnow-TIMlast),
[0114] 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.
[0115] 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;
[0116] 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;
[0117] 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;
[0118] Calculate the current throttle command difference with the last throttle output Tlast to obtain the current output throttle Tnow: Tnow = Tlast + Tdelta;
[0119] Set the current output throttle Tnow to Tlast.
[0120] 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.
[0121] refer to Figure 3 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.
[0122] refer to Figure 2 and Figure 4 This embodiment further discloses a control system for constant altitude flight based on the attitude of a hydrofoil vehicle, which specifically includes:
[0123] The attitude data acquisition module is used to acquire the attitude data of the current hydrofoil vehicle and the preset target height. Exemplarily, the attitude data acquisition module includes sensors such as accelerometers, gyroscopes, water pressure gauges, and rangefinders for acquiring data such as height, speed, and pitch angle.
[0124] The flight state judgment module is used to output the flight state judgment according to the attitude data and the target height; when the height data and speed data of the hydrofoil vehicle are obtained, the flight state judgment is realized. Exemplarily, in this embodiment, the flight state judgment method includes:
[0125] 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;
[0126] 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;
[0127] 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.
[0128] 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;
[0129] 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.
[0130] 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;
[0131] 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;
[0132] 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;
[0133] S9: Wait for the next round of judgment.
[0134] The flight status judgment module is also used to obtain a preset target pitch angle instruction and output the pitch angle instruction according to the flight status judgment. Specifically: when the flight status is judged to be a flight status, the target pitch angle instruction is turned on and output; when the flight status is judged to be a non-flight status, the target pitch angle instruction is turned off, and the preset pitch angle instruction is output; and after taking off to a height higher than the preset minimum take-off height through the preset pitch angle instruction, the target pitch angle instruction is turned on and output.
[0135] The control system also includes a controller module for outputting a throttle gain command based on attitude data and target pitch angle command; for details: Figure 2 In this embodiment, the controller module includes a pitch angle controller, a pitch angle rate controller and a pitch angle acceleration controller. The pitch angle controller is used to output a pitch angle rate command according to the target pitch angle command and the pitch angle data. The pitch angle rate controller is used to output a pitch angle acceleration command according to the pitch angle rate command and the pitch angle rate data. The pitch angle acceleration controller is used to output a throttle command pitch angle rate gain according to the pitch angle acceleration command and the pitch angle acceleration data. Since the environmental factors are complex when the vehicle is in use, problems such as equipment damage may occur. Therefore, the controller module also includes an abnormal protection controller for obtaining the system abnormal state. After generating the throttle output, the abnormal protection controller is required to obtain the system abnormal state. If the system abnormal state is received, such as the throttle is lost, the power output will be shut down until the throttle command is restored. For another example, when the sensor and the attitude data are received and estimated to be abnormal, the throttle gain command is set to zero, and only the user's throttle command is responded to. The above-mentioned restriction on the throttle is used to protect the safety of the user when using it.
[0136] The throttle control module is used to generate a throttle output according to the throttle command and the throttle gain command. In this embodiment, 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 pitch angle gain and the throttle command. Specifically, the control gain limiter is also used to: obtain the position information Tlocation of the throttle trigger; calculate the current maximum throttle gain limit amplitude Ttri_max 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; set the throttle gain command Ttri∈(-Ttri_max, Ttri_max). 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.
[0137] 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.
[0138] 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.
[0139] 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.
[0140] 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 constant altitude flight based on the attitude of a hydrofoil vehicle, characterized in that: The method comprises: Get the current hydrofoil vehicle's attitude data and preset target height; Output flight status judgment based on attitude data and target altitude; Obtain throttle command, and output throttle gain command according to attitude data, flight status judgment and throttle command; A throttle output is generated according to the throttle command and the throttle gain command.
2. The method for controlling the constant altitude flight based on the attitude of the hydrofoil vehicle according to claim 1, characterized in that: The attitude data includes altitude data and flight speed data, and the method for outputting flight status judgment according to the attitude 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.
3. The method for controlling the constant altitude flight based on the attitude of the hydrofoil vehicle according to claim 2, characterized in that: The attitude data also includes pitch data. The method of obtaining a throttle command and outputting a throttle gain command according to the attitude data, flight state judgment and the throttle command includes: Get the preset target pitch angle command, and output the pitch angle command according to the flight status. Specifically: When the flight state is judged to be a flight state, starting and outputting the target pitch angle instruction; When the flight state is determined to be 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.
4. The method for controlling the constant altitude flight based on the attitude of the hydrofoil vehicle according to claim 3, characterized in that: The pitch data includes pitch angle data and pitch angle rate data, and the method of outputting a throttle command pitch angle gain according to the throttle command, the pitch data and the target pitch angle command, and outputting a throttle gain command according to the throttle command and the throttle command pitch angle gain includes: Output a pitch angle rate instruction according to the target pitch angle instruction and the pitch angle data; Outputting a throttle command pitch rate gain according to the pitch rate command and the pitch rate data; A throttle gain command is output according to the throttle command and the throttle command pitch rate gain.
5. The method for controlling the constant altitude flight based on the attitude of the hydrofoil vehicle according to claim 3, characterized in that: The pitch data includes pitch angle data, pitch angle rate data and pitch angle acceleration data. The method of outputting a throttle command pitch angle gain according to the throttle command, the pitch data and the target pitch angle command, and outputting a throttle gain command according to the throttle command and the throttle command pitch angle gain 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.
6. The method for controlling the constant altitude flight based on the attitude of a hydrofoil vehicle according to any one of claims 1 to 5, 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; According to the throttle trigger position information Tlocation, calculate the current maximum throttle gain limit Ttri_max: 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.
7. The method for controlling the constant altitude flight based on the attitude of the hydrofoil vehicle according to 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.
8. 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-7.
9. A control system for constant altitude flight based on the attitude of a hydrofoil vehicle, characterized in that: The control system comprises: The attitude data acquisition module is used to obtain the attitude 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 attitude data and target altitude; The controller module obtains the throttle command and outputs the throttle gain command according to the attitude data, flight status judgment and throttle command; The throttle control module generates a throttle output according to the throttle command and the throttle gain command.
10. 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-7.
11. 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-7.
Citation Information
Cited By
Control method and system for altitude-hold flight of hydrofoil vehicle, and vehicle
WO2026016435A1
