A path tracking control method for unmanned boat based on economic model predictive control

Through the economic model prediction and control method, the problem of energy consumption and accuracy constraints of unmanned boats in complex environments is solved, efficient path tracking of unmanned boats in complex environments is realized, and energy loss and control performance are optimized.

CN118884965BActive Publication Date: 2024-12-06HUNAN UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411389199.1
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-10-08
Publication Date
2024-12-06
Estimated Expiration
2044-10-08

AI Technical Summary

Technical Problem

The existing intelligent control methods of unmanned boats are difficult to meet the dual constraints of energy consumption and accuracy in complex environments, and cannot effectively adapt to increasingly complex task requirements, especially in under-drive systems and highly nonlinear environments.

Method used

Using the unmanned boat path tracking control method based on economic model prediction control, the cost function of the economic model prediction control algorithm is constructed by establishing the nonlinear kinematic and dynamic models of the unmanned boat, the stage cost, terminal cost and error cost are calculated, and the cost function of the economic model prediction control algorithm is constructed. Optimize the track control of unmanned boats to achieve a balance of energy consumption and accuracy.

Benefits of technology

Real-time control of unmanned boats is achieved under certain disturbances, optimized energy loss and control performance, ensure that unmanned boats reach the target point with the smallest energy consumption and errors as possible, and improve the efficiency and accuracy of the trajectory route.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118884965B_ABST
    Figure CN118884965B_ABST
Patent Text Reader

Abstract

The present invention discloses a path tracking control method for an unmanned boat based on economic model predictive control, which establishes a nonlinear kinematic and dynamic model of an underactuated unmanned boat; discretizes the preset track information to obtain discretized target track point sequence information; obtains the working parameter information of the unmanned boat, combines the nonlinear kinematic and dynamic model to calculate the stage cost, terminal cost and error cost, and then determines the cost function of the economic model predictive control algorithm; the track controller based on the economic model predictive control takes the actual waypoints of the unmanned boat and the target track point sequence information as input, constructs an economic model predictive control constraint optimization problem, and controls the movement of the unmanned boat; when it is determined that the unmanned boat enters the acceptable range of the waypoint, and the waypoint is the last waypoint on the target track, the path tracking of the unmanned boat is completed. Under the premise of meeting the operation requirements of the unmanned boat in the actual environment, the energy loss and control performance of the unmanned boat are optimized.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention belongs to the technical field of control or regulation of non-electrical variables, and in particular relates to an unmanned boat path tracking control method based on economic model predictive control. Background Art

[0002] In recent years, the development of technologies such as digital wireless communication and intelligent remote control has provided good technical support for the development and design of unmanned boats. Unmanned boats have important military and civilian value due to their low risk, high mobility, deployability, and environmental adaptability. However, current research on the intelligent control of unmanned boats is concentrated in the environment of oceans or large lakes, and has limited performance in terms of navigation efficiency and accuracy, which cannot meet the needs of application in complex environments.

[0003] Unmanned boat trajectory control is an optimization problem that involves multiple disciplines, has many constraints, and is difficult to solve. Unmanned boats do not have lateral thrusters and cannot provide lateral thrust. They are typical under-actuated systems. Due to the high nonlinearity of the system, parameter perturbations, multi-objective control requirements, and limited control quantities, the design of control schemes is very challenging. Traditional control methods generally first mathematically model the unmanned boat to obtain a three-degree-of-freedom kinematic and dynamic model, and then further develop control algorithms based on the model, such as adaptive control, backstepping, sliding mode control, neural network algorithms, etc. However, in actual operating environments, the operation of unmanned boats is also restricted by environmental disturbances, trajectory errors, endurance, and other factors. Existing methods cannot adapt well to increasingly complex mission requirements. Therefore, how to design a high-performance control algorithm that meets the comprehensive constraints of unmanned boat energy consumption and accuracy under certain interference conditions requires further research.

[0004] In recent years, the use of nonlinear model predictive control (NMPC) algorithms for unmanned vehicle control has gradually become a research hotspot. Nonlinear model predictive control is a control algorithm that fully combines the object model of the controlled system with computer control technology. It can solve various problems such as nonlinearity, time-varying, time lag, and difficulty in establishing an accurate mathematical model in the control process of unmanned boats. In view of the energy consumption and accuracy issues, economic model predictive control (EMPC) is an advantageous solution to this problem. Based on this, a path tracking control method for unmanned boats based on economic model predictive control is proposed. Summary of the invention

[0005] In view of the above technical problems, the present invention provides an unmanned boat path tracking control method based on economic model predictive control.

[0006] The technical solution adopted by the present invention to solve the technical problem is:

[0007] A path tracking control method for an unmanned boat based on economic model predictive control, the method comprising the following steps:

[0008] S100: Establish nonlinear kinematic and dynamic models of underactuated unmanned vehicles;

[0009] S200: Discretize the preset track information to obtain discretized target track point sequence information;

[0010] S300: obtaining working parameter information of the unmanned boat, calculating the stage cost, terminal cost and error cost according to the working parameter information combined with the nonlinear kinematics and dynamics model, and determining the cost function of the economic model predictive control algorithm according to the stage cost, terminal cost and error cost;

[0011] S400: The track controller based on economic model predictive control takes the actual waypoints and target track point sequence information of the unmanned boat as input to construct the time The economic model predicts the control constraint optimization problem and controls the movement of the unmanned boat;

[0012] S500: When it is determined that the unmanned boat has entered the acceptable range of the waypoint, it is determined whether the waypoint is the last waypoint on the target track. If so, the path tracking of the unmanned boat is completed.

[0013] Preferably, S100 specifically includes:

[0014] ;

[0015] ;

[0016] in, is the position and heading angle of the unmanned boat in the earth coordinate system, is the linear velocity and angular velocity of the unmanned boat in the body coordinate system, m is the mass of the unmanned boat, It is the additional mass of the unmanned boat in the direction of advance, retreat, swing and yaw. is the damping coefficient of the unmanned boat in the directions of advance, retreat, swing and yaw, is the moment of inertia of the unmanned boat rotating around the heave direction, is the control input of the unmanned boat propulsion system, is the environmental disturbance force, is the distance between the propeller and the centerline of the unmanned boat.

[0017] Preferably, S300 includes:

[0018] S310: Obtain the power consumed by each propeller, the operating power of the unmanned boat and the time step within the prediction limit, and calculate the stage cost;

[0019] S320: In order to approximately determine the remaining energy required to predict the terminal to the target waypoint, the remaining energy is divided into a dynamic part and a static part. In the dynamic part, the angular velocity of the unmanned boat changes and is 0 at the end of the dynamic part. In the static part, the angular velocity of the unmanned boat remains 0, and the heading angle does not change. The power and duration of the dynamic part and the power and duration of the static part are obtained, and the terminal cost is calculated;

[0020] S330: Obtain the power to overcome the resistance at a constant forward and backward speed in the static part, The error cost is calculated by predicting the advance and retreat speed of the unmanned boat at the end of the time domain and the lateral trajectory error of the unmanned boat at the end of the prediction horizon.

[0021] S340: Determine the cost function of the economic model predictive control algorithm according to the stage cost, terminal cost and error cost.

[0022] Preferably, S310 specifically includes:

[0023] ;

[0024] in, To predict the k-step stage cost at time t, The power consumed by each thruster, is the operating power of the unmanned boat, is the time step within the forecast bounds.

[0025] Preferably, S320 specifically includes:

[0026] ;

[0027] Where E is the terminal cost, , are the power and duration of the dynamic part, , is the power and duration of the static part;

[0028] ;

[0029] ;

[0030] in It is the power to overcome the resistance at a constant forward and backward speed in the static part, while the energy in the dynamic part also includes the yaw control of the unmanned boat. , For the prediction time domain, for The unmanned boat predicts the advance and retreat speed at the end of the time domain. , , The thrust of the propeller can be derived from the kinematic model:

[0031] ;

[0032] and Then it satisfies:

[0033] ;

[0034] in is the difference between the expected heading of the unmanned boat at the end of the predicted horizon and its current heading, is the distance between the unmanned boat and the target waypoint at the end of the predicted horizon, is the discretized target track point sequence information.

[0035] Preferably, S330 specifically includes:

[0036] ;

[0037] in To predict the lateral trajectory error of the unmanned boat at the end of the horizon, when the unmanned boat is within the acceptable range of the waypoint, .

[0038] Preferably, S340 is specifically:

[0039] ;

[0040] in For the prediction time domain, is the stage cost of predicting k steps at time t, E is the terminal cost, and Y is the error cost.

[0041] Preferably, S400 includes:

[0042] The track controller based on economic model predictive control takes the actual waypoints and target track point sequence information of the unmanned boat as input and constructs the time The economic model predictive control constrained optimization problem is as follows:

[0043] ;

[0044] in, The state of the unmanned boat is is the nonlinear kinematic and dynamic model of the unmanned boat. is the upper limit of thruster thrust;

[0045] The constrained optimization problem is solved to obtain the next optimal control sequence, and the first predicted control input element is used as the actual control input, and the unmanned boat moves forward one step.

[0046] Preferably, determining in S500 that the unmanned boat enters an acceptable range of the waypoint is specifically as follows:

[0047] ;

[0048] in is the radius of the acceptable circle, It is the current waypoint location information of the unmanned boat.

[0049] Preferably, S500 further includes:

[0050] When the waypoint is not the last waypoint on the target track, the waypoint information is updated and the process returns to S400 until the unmanned boat reaches the target location.

[0051] The above-mentioned unmanned boat path tracking control method based on economic model predictive control can complete real-time control of the unmanned boat under certain disturbances by setting the economic objective function, so that it can meet the dual constraints of energy consumption and accuracy, that is, the unmanned boat reaches the target point with the smallest possible energy consumption and the smallest possible error, thereby realizing the operation requirements of the unmanned boat in the actual environment, obtaining a better trajectory route, and optimizing the energy loss and control performance of the unmanned boat. BRIEF DESCRIPTION OF THE DRAWINGS

[0052] Figure 1 It is a flow chart of an unmanned boat path tracking control method based on economic model predictive control of the present invention;

[0053] Figure 2 A three-dimensional model diagram of the unmanned boat of the present invention;

[0054] Figure 3 This is a schematic diagram of the cost stage division of the unmanned boat terminal of the present invention;

[0055] Figure 4 A schematic diagram of the trajectory of the unmanned boat of the present invention;

[0056] Figure 5 This is a schematic diagram of actual control input of the unmanned boat of the present invention;

[0057] Figure 6 A schematic diagram of the actual motion trajectory of the unmanned boat of the present invention and the lateral tracking error of the target tracking;

[0058] Figure 7 This is a schematic diagram of energy consumption of the unmanned boat of the present invention. DETAILED DESCRIPTION

[0059] In order to enable those skilled in the art to better understand the technical solution of the present invention, the present invention is further described in detail below in conjunction with the accompanying drawings.

[0060] The present invention overcomes the shortcomings of existing technologies and methods, and proposes an unmanned boat trajectory planning method based on economic model predictive control to meet the real-time control requirements of unmanned boats in different mission scenarios and ensure that the trajectory planning meets the dual constraints of trajectory error and energy loss.

[0061] In one embodiment, Figure 1 As shown, a path tracking control method for an unmanned boat based on economic model predictive control comprises the following steps:

[0062] S100: Establish nonlinear kinematic and dynamic models of underactuated unmanned vehicles;

[0063] S200: Discretize the preset track information to obtain discretized target track point sequence information;

[0064] S300: obtaining working parameter information of the unmanned boat, calculating the stage cost, terminal cost and error cost according to the working parameter information combined with the nonlinear kinematics and dynamics model, and determining the cost function of the economic model predictive control algorithm according to the stage cost, terminal cost and error cost;

[0065] S400: The track controller based on economic model predictive control takes the actual waypoints and target track point sequence information of the unmanned boat as input to construct the time The economic model predicts the control constraint optimization problem and controls the movement of the unmanned boat;

[0066] S500: When it is determined that the unmanned boat has entered the acceptable range of the waypoint, it is determined whether the waypoint is the last waypoint on the target track. If so, the path tracking of the unmanned boat is completed.

[0067] The above-mentioned unmanned boat path tracking control method based on economic model predictive control can complete real-time control of the unmanned boat under certain disturbances, so that it can meet the dual constraints of energy consumption and accuracy, and then realize the operation requirements of the unmanned boat in the actual environment, and optimize the energy loss and control performance of the unmanned boat.

[0068] In one embodiment, S100 specifically includes:

[0069] ;

[0070] ;

[0071] in, is the position and heading angle of the unmanned boat in the earth coordinate system, is the linear velocity and angular velocity of the unmanned boat in the body coordinate system, m is the mass of the unmanned boat, It is the additional mass of the unmanned boat in the direction of advance, retreat, swing and yaw. is the damping coefficient of the unmanned boat in the directions of advance, retreat, swing and yaw, is the moment of inertia of the unmanned boat rotating around the heave direction, is the control input of the unmanned boat propulsion system, is the environmental disturbance force, is the distance between the propeller and the centerline of the unmanned boat. The structure of the unmanned boat is as follows Figure 2 shown.

[0072] In one embodiment, S300 includes:

[0073] S310: Obtain the power consumed by each propeller, the operating power of the unmanned boat and the time step within the prediction limit, and calculate the stage cost;

[0074] S320: In order to approximately determine the remaining energy required to predict the terminal to the target waypoint, the remaining energy is divided into a dynamic part and a static part. In the dynamic part, the angular velocity of the unmanned boat changes and is 0 at the end of the dynamic part. In the static part, the angular velocity of the unmanned boat remains 0, and the heading angle does not change. The power and duration of the dynamic part and the power and duration of the static part are obtained, and the terminal cost is calculated;

[0075] S330: Obtain the power to overcome the resistance at a constant forward and backward speed in the static part, The error cost is calculated by predicting the advance and retreat speed of the unmanned boat at the end of the time domain and the lateral trajectory error of the unmanned boat at the end of the prediction horizon.

[0076] S340: Determine the cost function of the economic model predictive control algorithm according to the stage cost, terminal cost and error cost.

[0077] In one embodiment, S310 specifically includes:

[0078] ;

[0079] in, To predict the k-step stage cost at time t, The power consumed by each thruster, is the operating power of the unmanned boat, is the time step within the forecast bounds.

[0080] In one embodiment, S320 specifically includes:

[0081]

[0082] Where E is the terminal cost, , are the power and duration of the dynamic part, , is the power and duration of the static part;

[0083] ;

[0084] ;

[0085] in It is the power to overcome the resistance at a constant forward and backward speed in the static part, while the energy in the dynamic part also includes the yaw control of the unmanned boat. , For the prediction time domain, for The unmanned boat predicts the advance and retreat speed at the end of the time domain. , , The thrust of the propeller can be derived from the kinematic model:

[0086] ;

[0087] and Then it satisfies:

[0088] ;

[0089] in is the difference between the expected heading of the unmanned boat at the end of the predicted horizon and its current heading, is the distance between the unmanned boat and the target waypoint at the end of the predicted horizon, is the discretized target track point sequence information.

[0090] In one embodiment, S330 specifically includes:

[0091] ;

[0092] in To predict the lateral trajectory error of the unmanned boat at the end of the horizon, when the unmanned boat is within the acceptable range of the waypoint, .

[0093] In one embodiment, S340 is specifically:

[0094] ;

[0095] in For the prediction time domain, is the stage cost of predicting k steps at time t, E is the terminal cost, and Y is the error cost.

[0096] Specifically, the remaining energy is divided into dynamic and static parts, such as Figure 3 As shown in the figure, by dividing the unmanned boat from the end of the predicted horizon to the target waypoint into different stages, the terminal cost of the unmanned boat can be calculated; is the power consumption and duration of the dynamic part, is the power consumption and duration of the static part, is the target track point location information, To predict the position information of the unmanned boat at the end of the horizon, It is the position information corresponding to the unmanned boat entering the static stage from the dynamic stage. It is the difference between the expected heading of the unmanned boat at the end of the predicted horizon and its current heading.

[0097] In one embodiment, S400 includes:

[0098] The track controller based on economic model predictive control takes the actual waypoints and target track point sequence information of the unmanned boat as input and constructs the time The economic model predictive control constrained optimization problem is as follows:

[0099] ;

[0100] in, The state of the unmanned boat is is the nonlinear kinematic and dynamic model of the unmanned boat. is the upper limit of thruster thrust;

[0101] The constrained optimization problem is solved to obtain the next optimal control sequence, and the first predicted control input element is used as the actual control input, and the unmanned boat moves forward one step.

[0102] In one embodiment, determining in S500 that the unmanned boat enters an acceptable range of the waypoint is specifically as follows:

[0103] ;

[0104] in is the radius of the acceptable circle, It is the current waypoint location information of the unmanned boat.

[0105] In one embodiment, S500 further includes:

[0106] When the waypoint is not the last waypoint on the target track, the waypoint information is updated and the process returns to S400 until the unmanned boat reaches the target location.

[0107] The actual control effect of the unmanned boat track control method based on economic model predictive control is shown in the attached figure. Figure 4 As shown, the prediction bounds , sampling time The initial position of the unmanned boat is (0, 0), the target waypoints are (15m, 0) and (15m, 20m), and the radius of the acceptable circle is , the upper limit of the thrust of the unmanned boat , and the environmental disturbance force is evenly distributed in [-0.5N, 0.5N]. It can be seen from the figure that the designed controller can complete the path tracking from the starting point to the target area under certain disturbances; compared with the traditional NMPC control, the path tracking effect of the economic model predictive control method is more accurate.

[0108] Further, Figure 5 A schematic diagram of actual control input of the unmanned boat is provided to realize the present invention. It can be seen from the figure that the control input of the unmanned boat can meet the actual constraints of the system. Figure 6 A schematic diagram of the lateral tracking error of the actual motion trajectory and target tracking of the unmanned boat of the present invention is provided. It can be seen from the figure that the control scheme can stabilize the lateral tracking error of the unmanned boat within 1.85m, and has a good path tracking effect. Figure 7 A schematic diagram of the actual energy consumption of the unmanned boat of the present invention is provided. From the figure, it can be seen that although the time taken by the control scheme to complete path tracking is greater than that of the existing nonlinear model predictive control method, the total energy consumed is far less than the energy used by the nonlinear model predictive control method to complete the corresponding task.

[0109] Compared with the prior art, the present invention proposes a path tracking control method for unmanned boats based on economic model predictive control, designs a control framework that explicitly considers ship dynamics, energy demand and trajectory error, controls the real-time motion of the unmanned boat during the tracking process, and adopts a rolling optimization strategy to improve the ability of the designed motion controller to cope with dynamic environments. At the same time, the energy loss and trajectory error in the predicted terminal state are included in the cost function to generate a continuous, smooth and more energy-saving control signal, while ensuring that the unmanned boat can achieve approximately the lowest energy consumption, the navigation process of the unmanned boat is realized with high precision, effectively improving the control effect, and having practical application value.

[0110] To sum up, the unmanned boat path tracking control method based on economic model predictive control in the embodiment of the present invention can complete the real-time control of the unmanned boat under certain disturbances by setting the economic objective function, so that it meets the dual constraints of energy consumption and accuracy, that is, the unmanned boat reaches the target point with the smallest possible energy consumption and the smallest possible error, thereby realizing the operation requirements of the unmanned boat in the actual environment, obtaining a better trajectory route, and optimizing the energy loss and control performance of the unmanned boat.

[0111] The above is a detailed introduction to the unmanned boat path tracking control method based on economic model predictive control provided by the present invention. This article uses specific examples to illustrate the principles and implementation methods of the present invention. The description of the above embodiments is only used to help understand the core idea of ​​the present invention. It should be pointed out that for ordinary technicians in this technical field, without departing from the principles of the present invention, the present invention can also be improved and modified, and these improvements and modifications also fall within the scope of protection of the claims of the present invention.

Claims

1. A path tracking control method for an unmanned boat based on economic model predictive control, characterized in that: The method comprises the following steps: S100: Establish nonlinear kinematic and dynamic models of underactuated unmanned vehicles; S200: Discretize the preset track information to obtain discretized target track point sequence information; S300: Obtain the working parameter information of the unmanned boat, calculate the stage cost, terminal cost and error cost according to the working parameter information combined with the nonlinear kinematics and dynamics model, and determine the cost function of the economic model predictive control algorithm according to the stage cost, terminal cost and error cost; the error cost calculation is specifically as follows: ; in To predict the lateral trajectory error of the unmanned boat at the end of the horizon, when the unmanned boat is within the acceptable range of the waypoint, , for The unmanned boat predicts the advance and retreat speed at the end of the time domain. The power to overcome resistance at a constant forward and backward speed in the static part; The cost function of the economic model predictive control algorithm is determined based on the stage cost, terminal cost and error cost, specifically: ; in For the prediction time domain, is the stage cost of predicting k steps at time t, E is the terminal cost, and Y is the error cost; S400: The track controller based on economic model predictive control takes the actual waypoints and target track point sequence information of the unmanned boat as input to construct the time The economic model predicts the control constraint optimization problem and controls the movement of the unmanned boat; S500: When it is determined that the unmanned boat has entered the acceptable range of the waypoint, it is determined whether the waypoint is the last waypoint on the target track. If so, the path tracking of the unmanned boat is completed.

2. The method according to claim 1, characterized in that S100 is specifically: ; ; in, is the position and heading angle of the unmanned boat in the earth coordinate system, is the linear velocity and angular velocity of the unmanned boat in the body coordinate system, m is the mass of the unmanned boat, It is the additional mass of the unmanned boat in the direction of advance, retreat, swing and yaw. is the damping coefficient of the unmanned boat in the directions of advance, retreat, swing and yaw, is the moment of inertia of the unmanned boat rotating around the heave direction, is the control input of the unmanned boat propulsion system, is the environmental disturbance force, is the distance between the propeller and the centerline of the unmanned boat.

3. The method according to claim 2, characterized in that S300 includes: S310: Obtain the power consumed by each propeller, the operating power of the unmanned boat and the time step within the prediction limit, and calculate the stage cost; S320: In order to approximately determine the remaining energy required to predict the terminal to the target waypoint, the remaining energy is divided into a dynamic part and a static part. In the dynamic part, the angular velocity of the unmanned boat changes and is 0 at the end of the dynamic part. In the static part, the angular velocity of the unmanned boat remains 0, and the heading angle does not change. The power and duration of the dynamic part and the power and duration of the static part are obtained, and the terminal cost is calculated; S330: Obtain the power to overcome the resistance at a constant forward and backward speed in the static part, The error cost is calculated by predicting the advance and retreat speed of the unmanned boat at the end of the time domain and the lateral trajectory error of the unmanned boat at the end of the prediction horizon. S340: Determine the cost function of the economic model predictive control algorithm according to the stage cost, terminal cost and error cost.

4. The method according to claim 3, characterized in that S310 is specifically: ; in, To predict the k-step stage cost at time t, The power consumed by each thruster, is the operating power of the unmanned boat, is the time step within the forecast bounds.

5. The method according to claim 4, characterized in that S320 is specifically: ; Where E is the terminal cost, , are the power and duration of the dynamic part, , is the power and duration of the static part; ; ; in It is the power to overcome the resistance at a constant forward and backward speed in the static part, while the energy in the dynamic part also includes the yaw control of the unmanned boat. , For the prediction time domain, for The unmanned boat predicts the advance and retreat speed at the end of the time domain. , , The thrust of the propeller can be derived from the kinematic model: ; and Then it satisfies: ; in is the difference between the expected heading of the unmanned boat at the end of the predicted horizon and its current heading, is the distance between the unmanned boat and the target waypoint at the end of the predicted horizon, is the discretized target track point sequence information.

6. The method according to claim 5, characterized in that S400 includes: The track controller based on economic model predictive control takes the actual waypoints and target track point sequence information of the unmanned boat as input and constructs the time The economic model predictive control constrained optimization problem is as follows: ; in, The state of the unmanned boat is is the nonlinear kinematic and dynamic model of the unmanned boat. is the upper limit of thruster thrust; The constrained optimization problem is solved to obtain the next optimal control sequence, and the first predicted control input element is used as the actual control input, and the unmanned boat moves forward one step.

7. The method according to claim 6, characterized in that S500 determines the acceptable range of the unmanned boat entering the waypoint, specifically: ; in is the radius of the acceptable circle, It is the current waypoint location information of the unmanned boat.

8. The method according to claim 7, characterized in that The S500 also includes: When the waypoint is not the last waypoint on the target track, the waypoint information is updated and the process returns to S400 until the unmanned boat reaches the target location.