Parameter online adjusting method of unmanned aerial vehicle system controller
By combining an online adjustment method of artificial potential field function and time-varying robust obstacle control function, the signal timing logic task problem of UAVs under unknown and restricted conditions is solved, realizing autonomous obstacle avoidance and target task completion of UAVs in complex environments.
Patent Information
- Application Number
- CN202410989505.9
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-07-23
- Publication Date
- 2024-11-12
- Estimated Expiration
- 2044-07-23
AI Technical Summary
Existing unmanned aerial vehicle (UAV) systems struggle to effectively complete signal timing and logic tasks in unknown environments or under limited control input conditions. In particular, the conflict between target arrival and obstacle avoidance is difficult to resolve, affecting control performance.
An obstacle avoidance controller based on an artificial potential field function and a target arrival controller based on a time-varying robust obstacle function are adopted. The constraint parameters of the time-varying robust obstacle function are combined for online adjustment, and the constraint parameters are updated in real time to adapt to unknown environments and limited conditions.
Unmanned aerial vehicles (UAVs) can autonomously avoid obstacles and complete target-sequential logic tasks in unknown environments and under restricted conditions, improving task completion performance and the forward invariance of the system.
Smart Images

Figure CN118938951A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the technical field of unmanned aerial vehicle control, and in particular to an online parameter adjustment method for an unmanned aerial vehicle system controller. Background Art
[0002] In the field of modern control theory, the control obstacle function, as a key technology, has been widely used in the controller design of UAV signal sequential logic tasks. This is an extension of the open-loop system obstacle function. Some scholars have demonstrated a method that combines the control obstacle function with quadratic programming and has been applied in safety-critical systems, paving the way for subsequent research. In order to better meet the complex requirements of signal sequential logic tasks, a new control obstacle function design strategy is proposed, which realizes the generation of controllers through quadratic programming. This method has been further developed in dealing with risk signal sequential logic tasks faced by non-complete systems, and explores strategies for achieving effective control in uncertain environments.
[0003] However, these methods face challenges in dealing with the contradiction between target reaching and obstacle avoiding. The presence of obstacles may make the quadratic programming problem unsolvable, thus affecting the control effect. To overcome this problem, researchers have introduced a new control framework that combines artificial potential fields with control obstacle functions, which effectively solves the conflict between the target and obstacles and ensures the solvability and performance of the control problem.
[0004] Even so, when the obstacle avoidance mechanism in the framework is activated, the reachability of the target point depends largely on the selection of the control obstacle function parameters. The pre-determined control obstacle function in existing schemes often fails to meet the complex requirements of signal timing logic tasks under unknown environments or limited control input conditions. Summary of the invention
[0005] The purpose of the present invention is to overcome the above-mentioned defects or problems existing in the background technology and to provide a method for online adjustment of parameters of a drone system controller, through which the drone can better meet the complex requirements of signal timing logic tasks under unknown environments or limited control input conditions.
[0006] To achieve the above object, the present invention adopts the following technical solutions:
[0007] Technical Solution 1: A method for online adjustment of parameters of a drone system controller, wherein the drone completes a signal timing logic task under the control of the system controller; the system controller includes an obstacle avoidance controller generated based on an artificial potential field function and a target arrival controller generated based on a time-varying robust control obstacle function; in the target arrival controller, the time-varying robust control obstacle function includes a predicate function corresponding to a target area and constraint parameters determined based on the signal timing logic task; during the operation of the drone, the constraint parameters are updated in real time through the following steps: Step 1: Obtain the predicate function and robustness parameter corresponding to the target area; Step 2: Initialize the time parameter and constraint parameter based on the nature of the signal timing logic task currently being performed by the drone; Step 3: When the time-varying robust control obstacle function is a non-positive number, update the constraint parameter according to a preset update rule; Step 4: Within a preset period, determine whether the time-varying robust control obstacle function corresponding to the constraint parameter is less than or equal to 0, if yes, return to step 3 to continue updating the constraint parameter, otherwise keep the constraint parameter obtained after the last update; wherein the time-varying robust control obstacle function is composed of In other words, in the proposition φ s The kth time-varying robust control barrier function is The predicate function corresponding to the target area is h g,s,k (x), the constraint parameter is γ s,k (t), and in, The initial state of the drone is x0=x(t0), let Then γ s,k (t) Initialize and update the constraint parameters in step 3 based on the following rules: In the above rules, ρ s,k is the robustness parameter, ρ s,k >0; is the time parameter, Represents the predicate function h corresponding to the predicate logic μ g,s,k (x) In Proposition F [a,b] In ψ, Represents the predicate function h corresponding to the predicate logic μ g,s,k (x) In Proposition G [a,b] In ψ, ψ is the area of the signal timing logic task currently performed by the UAV; Indicated in When the predicate function h g,s,k The supremum of (x), r s,k is the robustness coefficient for proposition completion, r s,k ∈R >0 , R >0is a pre-set set of positive real numbers; Δ s,k To update the constraint parameters, Δ s,k ∈(0,γ s,k,∞ ).
[0008] Technical solution 2 based on technical solution 1: In step 2, the time parameter is initialized as follows: when φ s =φ1, t0 = 0; when φ s When s≥2, t0=b s-1 .
[0009] Technical solution 3 based on technical solution 2: In step 3, when the current time t is less than the time parameter and When t is less than or equal to 0, new =t, Update γ based on the update rule s,k,0 , juxtapose h g,s,k (x0) = h g,s,k (x), at this time And according to Calculate γ s,k (t); among them, Greater than or equal to the preset l max hour,
[0010] Technical solution 4 based on technical solution 3: In step 3, when the current time t is greater than or equal to the time parameter and When t is less than or equal to 0, new =t, update γ based on the update rule s,k,0 , juxtapose h g,s,k (x0) = h g,s,k (x), according to γ s,k (t) = (γ s,k,0 -γ s,k,∞ )exp(-l max (tt new ))+γ s,k,∞ Calculate γ s,k (t).
[0011] Technical solution 5 based on technical solution 4: During the updating process of the constraint parameters, if If it is greater than 0, the γ obtained after the last update is kept s,k (t).
[0012] Technical solution 6 based on technical solution 1: the obstacle avoidance controller is generated based on the artificial potential field function; for each proposition φ s , whose artificial potential field function is defined as Us (x) = U attr,s (x)+∑ k U rep,s,k (x); where U attr,s (x) is the gravitational potential field, For the UAV in the proposition φ s The target state is π o,s,k is the set of obstacles perceived by the drone at time t The predicate function h of the kth obstacle in o,s,k The zero level set of (x(t)), With r o,s,k is φ s The center and radius of the kth obstacle in U rep,s,k (x) is φ s The repulsive potential field of the kth obstacle in is, The choice satisfies And function The zero-level set of k does not intersect, s , η s,k is a positive scalar parameter; the obstacle avoidance controller u cpf,s Generated by solving the following quadratic programming problem: Among them, c s To adjust the obstacle avoidance rate parameter, c s >0; Based on the solution of the above quadratic programming problem, the obstacle avoidance controller u cpf,s In the following form:
[0013] in, To solve the above quadratic programming problem, we obtain the optimal controller; C g , C d is the threshold of gradient and distance, C g >0,C d > 0; δ is bounded perturbation, δ∈R m ; C g , C d and δ satisfy the following conditions: ||g(x)δ||≤C δ , and the set In each time interval t∈[a s ,b s ] is not an invariant set.
[0014] Technical Solution 7 based on Technical Solution 6: The target reaching controller is generated based on the time-varying robust control obstacle function; for each proposition φ s , the target reaches the controller u cbf,s Generated by solving the following quadratic programming problem: Where Q∈R m×m is a positive definite matrix, α s :(-∞,+∞)→(-∞,+∞) is the expansion Class function, satisfying α s (0) = 0 and strictly monotonically increasing, is the time-varying robust control barrier function, Where η>0.
[0015] Technical solution eight based on technical solution seven: the system controller u s Including the obstacle avoidance controller u cpf,s and the target reaches the controller u cbf,s , which is of the following form: s =λ s (x,h ob,s (x,t))u cbf,s +(1-λ s (x,h ob,s (x,t)))u cpf,s ; Among them, h ob,s (x) is the smooth lower approximation of the predicate function of all obstacles perceived by the drone, η ob >0,λ s (x,h ob,s (x) is defined as Ensure s (x,h ob,s (x,t))∈[0,1],β s is the decision function λ s (x,h ob,s (x,t)) decay rate constant.
[0016] Technical solution 9 based on technical solution 8: In step 4, for any k, if there is a moment In the time interval The constraint parameter γ s,k (t) No update occurred and in the time interval Inner s,k (t)>0, determine each sequential logic task φ s All completed.
[0017] It can be seen from the above description of the present invention that, compared with the prior art, the present invention has the following beneficial effects:
[0018] The parameter online adjustment method of the drone system controller provided by the present invention generates an obstacle avoidance controller based on the existing artificial potential field function, and generates a target arrival controller based on the existing time-varying robust control obstacle function. The two are combined to form a system controller, and the drone is controlled by the system controller to complete a preset signal sequential logic task, so that the drone can avoid obstacles by itself when approaching any perceived obstacle, and can fly toward the target position to complete the target sequential logic task when the drone is far away from any perceived obstacle. However, the inventor found in the actual research process that when only relying on the above-mentioned system controller, when facing an unknown environment or a situation under limited control input conditions, the operation of the drone is often difficult to ensure the forward invariance of the corresponding control obstacle function, thereby affecting the completion performance of the drone task. To this end, the inventor adjusts the constraint parameters in the time-varying robust control obstacle function online, so that the drone can adjust the corresponding constraint parameters in real time based on its current state information and the nature of the signal sequential logic task, so that the drone can better complete the signal sequential logic task with complex requirements under the disturbance of the unknown environment or under limited control input conditions. BRIEF DESCRIPTION OF THE DRAWINGS
[0019] In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the following briefly introduces the drawings required for use in the description of the embodiments. Obviously, the drawings described below are some embodiments of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without creative work.
[0020] Figure 1 A flow chart of a parameter online adjustment method provided by an embodiment of the present invention;
[0021] Figure 2 A schematic diagram of a drone experiment scenario provided by an embodiment of the present invention;
[0022] Figure 3 A trajectory diagram of a drone when completing a task provided by an embodiment of the present invention;
[0023] Figure 4 A graph showing the changes in the values of h(x) and γ(t) when the drone provided in an embodiment of the present invention completes a task;
[0024] Figure 5 The control obstacle function of the drone provided by the embodiment of the present invention when completing the task The numerical change diagram of ;
[0025] Figure 6 A numerical diagram of the speed control instruction u of the UAV provided in an embodiment of the present invention when completing a task. DETAILED DESCRIPTION
[0026] The technical solutions in the embodiments of the present invention will be described clearly and completely below in conjunction with the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are preferred embodiments of the present invention and should not be regarded as excluding other embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.
[0027] In the claims, description and drawings of the present invention, if the terms "include", "have" and their variations are used, they are intended to mean "including but not limited to".
[0028] An embodiment of the present invention provides a method for online adjustment of parameters of an unmanned aerial vehicle system controller, wherein the unmanned aerial vehicle completes a signal timing logic task under the control of the system controller; the system controller includes an obstacle avoidance controller generated based on an artificial potential field function and a target arrival controller generated based on a time-varying robust control obstacle function.
[0029] Among them, in the target arrival controller, the time-varying robust control obstacle function includes the predicate function corresponding to the target area and the constraint parameters determined based on the signal timing logic task; and, referring to Figure 1 During the operation of the UAV, the constraint parameters are updated in real time through the following steps:
[0030] Step 1: Obtain the predicate function and robustness parameters corresponding to the target area.
[0031] Step 2: Initialize time parameters and constraint parameters based on the nature of the signal timing logic task currently being performed by the drone;
[0032] Step 3: When the time-varying robust control barrier function is a non-positive number, updating the constraint parameters according to a preset updating rule;
[0033] Step 4: Within a preset period, determine whether the time-varying robust control barrier function corresponding to the constraint parameter is less than or equal to 0. If so, return to step 3 to continue updating the constraint parameter. If not, keep the constraint parameter obtained after the last update.
[0034] The above-mentioned system controller and the updating process of the constraint parameters are further described below.
[0035] In this embodiment, R is defined as a real number set, R n is an n-dimensional real vector space, R >0 ,R ≥0 are the sets of positive real numbers and non-negative real numbers respectively. Define the shortest distance from vector x to set A as dist(x,A), and the trajectory of vector x(t) as traj(x). Define the Euclidean norm as ||·||.
[0036] In this embodiment, the UAV system is defined as a nonlinear input affine model: Formula (1) Where x∈R n and Represents the system state and system control input; function f:R n →R n and g:R n →R n×m Satisfies local Lipschitz continuity; the drone state x is in a finite space The matrix function g of the UAV system satisfies all satisfies g(x)g(x) T Zhengding.
[0037] The above-mentioned UAV system (1) is limited by the upper-level signal timing logic task specification, by evaluating the predicate function h:R n →R to determine predicate logic Among them, the syntax of the signal sequential logic task φ is defined as: φ1 and φ2 are signal sequential logic task propositions, a, b∈R ≥0 And a≤b.
[0038] The semantics of the above signal sequential logic task proposition φ is defined as:
[0039]
[0040] Specifically, in this embodiment, the target arrival signal timing logic task assigned to the UAV system (1) can be expressed by the following syntax:
[0041] Among them, the drone has sensors that can sense obstacles near it in real time online.
[0042] Define the drone’s surrounding perception radius as Circle area All obstacles within can be sensed through sensor data. Assume that the obstacles sensed by the drone can be modeled as isolated non-intersecting circular domains. Define the set To complete φ s The set of obstacles perceived by the drone at time t during the process. The predicate function of the kth obstacle in is: With r o,s,k is φ s The center and radius of the kth obstacle in .
[0043] Define the drone to complete the target proposition φ goalThe obstacle proposition φ when safely avoiding all perceived obstacles during the process obs , that is, for any t∈[0,b K ], Assume that the initial state of the drone system (1) x0: = x(0) does not belong to h o,s,k The union of the zero-level sets of (x(t)) in the target task φ s The kth target area in is π g,s,k When , the corresponding predicate function is formula (3) The target state is not time-varying, and the UAV system (1) exists to satisfy φ s A feasible solution of .
[0044] Therefore, the goal to be achieved by the system controller provided in this embodiment is: Established.
[0045] The following first describes the design of the obstacle avoidance controller in the system controller.
[0046] For each proposition φ s , its artificial potential field function is defined as formula (5)U s (x) = U attr,s (x)+∑ k U rep,s,k (x); where U attr,s (x) is the gravitational potential field, For the UAV in the proposition φ s The target state is π o,s,k is the set of obstacles perceived by the drone at time t The predicate function h of the kth obstacle in o,s,k The zero level set of (x(t)), With r o,s,k is φ s The center and radius of the kth obstacle in U rep,s,k (x) is φ s The repulsive potential field of the kth obstacle in is, The choice satisfies And the function (6) The zero-level set of k does not intersect, s , η s,k is a positive scalar parameter.
[0047] Obstacle Avoidance Controller cpf,s It is generated by solving the following quadratic programming problem: Among them, c sTo adjust the obstacle avoidance rate parameter, c s >0.
[0048] In order to prevent the UAV system (1) from being trapped in a local minimum point, based on the solution of the above quadratic programming problem, the obstacle avoidance controller u cpf,s It is in the following form: Formula (8) in, To solve the above quadratic programming problem, we obtain the optimal controller; C g , C d is the threshold of gradient and distance, C g >0,C d > 0; δ is bounded perturbation, δ∈R m ; C g , C d and δ satisfy the following conditions: ||g(x)δ||≤C δ , and the set In each time interval t∈[a s ,b s ] is not an invariant set.
[0049] Based on the above obstacle avoidance controller, let the target state and The maximum distance of the subzero level set is If the parameter k of the artificial potential field function s With η s,k satisfy: Then the obstacle avoidance controller u cpf,s The UAV system (1) can meet the safety requirements, that is,
[0050] The following describes the design of the target reaching controller in the system controller.
[0051] For each proposition φ s , the target reaches the controller u cbf,s It is generated by solving the following quadratic programming problem: Where Q∈R m×m is a positive definite matrix, α s :(-∞,+∞)→(-∞,+∞) is the expansion Class function, satisfying α s (0) = 0 and strictly monotonically increasing, is the time-varying robust control barrier function, Where η>0, is φ s The kth time-varying robust control barrier function in the present invention is described in the specification and claims with the subscript “s, k”. sFunction and parameter information in the kth time-varying robust control barrier function.
[0052] Among them, the time-varying robust control barrier function is in the following form: Among them, h g,s,k (x) is the predicate function corresponding to the target area; γ s,k (t) is a constraint parameter, which constrains h(x) according to the properties of the signal timing logic task, thereby completing the corresponding logic task.
[0053] The design of the system controller is described below.
[0054] System Controller s Including the obstacle avoidance controller u cpf,s and the target reaches the controller u cbf,s , which is of the following form: s =λ s (x,h ob,s (x,t))u cbf,s +(1-λ s (x,h ob,s (x,t)))u cpf,s ; Among them, h ob,s (x) is the smooth lower approximation of the predicate function of all obstacles perceived by the drone, As shown in formula (6); s (x,h ob,s (x) is defined as Ensure s (x,h ob,s (x,t))∈[0,1],β s is the decision function λ s (x,h ob,s (x,t)) decay rate constant.
[0055] The following is an explanation of the online parameter adjustment method of the above-mentioned UAV system controller.
[0056] After obtaining the above system controller through the obstacle avoidance controller and the target arrival controller, since the system controller does not take into account the situation under unknown environment or limited control input conditions, the operation of the drone is often difficult to ensure forward invariance, resulting in When the system returns to the collection The time within depends largely on the expansion Class function α s The selection of the parameters will affect the performance of the UAV mission.
[0057] In the target arrival controller, The initial state of the drone is x0 = x(t0), let Then γ s,k (t) Initialize and update the constraint parameters in step 3 based on the following rules: Formula (10)
[0058]
[0059]
[0060] In formula (10), ρ s,k is the robustness parameter, is the time parameter, Represents the predicate function h corresponding to the predicate logic μ g,s,k (x) In Proposition F [a,b] In ψ, Represents the predicate function h corresponding to the predicate logic μ g,s,k (x) In Proposition G [a,b] In ψ, ψ is the area of the signal timing logic task currently performed by the UAV; Indicated in When the predicate function h g,s,k The supremum of (x), r s,k is the robustness coefficient for proposition completion, r s,k ∈R >0 , R >0 is a pre-set set of positive real numbers; Δ s,k To update the constraint parameters, Δ s,k ∈(0,γ s,k,∞ ). In order to avoid the Zeno phenomenon, the parameter I s,k are all positive real numbers, and l max >0 is The updated upper bound is When belongs to γ s,k Parameters in (t).
[0061] In step 2, the time parameters are initialized as follows: s =φ1, t0 = 0; when φ s When s≥2, t0=b s-1 .
[0062] In step 3, when the current time t is less than the time parameter and When t is less than or equal to 0, new =t, Update γ based on the above formula (10)s,k,0 , juxtapose h g,s,k (x0) = h g,s,k (x), at this time And according to Calculate γ s,k (t); among them, Greater than or equal to the preset l max hour,
[0063] In step 3, when the current time t is greater than or equal to the time parameter and When t is less than or equal to 0, new =t, update γ based on the update rule s,k,0 , juxtapose h g,s,k (x0) = h g,s,k (x), according to γ s,k (t) = (γ s,k,0 -γ s,k,∞ )exp(-l max (tt new ))+γ s,k,∞ Calculate γ s,k (t).
[0064] During the constraint parameter update process, if If it is greater than 0, the γ obtained after the last update is output s,k (t).
[0065] In step 4, if there is a moment In the time interval The constraint parameter γ s,k (t) No update occurred and in the time interval Inner s,k (t)>0, then output the constraint parameter γ obtained after the last update s,k (t).
[0066] The parameter online adjustment method of the drone system controller provided by the present invention generates an obstacle avoidance controller based on the existing artificial potential field function, and generates a target arrival controller based on the existing time-varying robust control obstacle function. The two are combined to form a system controller, and the drone is controlled by the system controller to complete a preset signal sequential logic task, so that the drone can avoid obstacles by itself when approaching any perceived obstacle, and can fly toward the target position to complete the target sequential logic task when the drone is far away from any perceived obstacle. However, the inventor found in the actual research process that when only relying on the above-mentioned system controller, when facing an unknown environment or a situation under limited control input conditions, the operation of the drone is often difficult to ensure the forward invariance of the corresponding control obstacle function, thereby affecting the completion performance of the drone task. To this end, the inventor adjusts the constraint parameters in the time-varying robust control obstacle function online, so that the drone can adjust the corresponding constraint parameters in real time based on its current state information and the nature of the signal sequential logic task, so that the drone can better complete the signal sequential logic task with complex requirements under the disturbance of the unknown environment or under limited control input conditions.
[0067] To further illustrate the effectiveness of the above-mentioned method for online parameter adjustment of the drone system controller, the present invention conducts the following experiments and analyzes the experimental results through Figures 2 to 6 Provide explanation.
[0068] The drone used in this experiment is equipped with multiple optical motion capture full reflection light balls and a 360° two-dimensional laser radar. The optical motion capture full reflection light balls are used to calculate and obtain the global information of the drone in the VICON optical motion capture system, and the two-dimensional laser radar is used to sense obstacles near the drone. The axial (front, back, left, and right) speed command is the control input u of the drone.
[0069] Experimental scenario Figure 2 As shown, Figure 2 There are two obstacles on the experimental platform, and their global positions are [0.12, 3.61] T ,[0.27,-0.56] T , corresponding to radii of 0.36m and 0.56m respectively. The drone has no prior knowledge of obstacles at the initial moment, and needs to perceive surrounding obstacle information in real time and ensure the safety of the drone itself when completing the signal timing logic task. The signal timing logic task of this experiment is assigned to the drone after the drone rises and stabilizes to the desired height, and the moment when the drone starts to execute the signal timing logic task is defined as t0. The target arrival signal timing logic task assigned to the drone in this experiment is as follows: φ1=G [15,20] (||x-[2,3.22] T||≤0.5);φ2=F [40,60] (||x-[-2,3.17] T ||≤0.5);φ3=F [110,120] (||x-[1,-3.17] T ||≤0.5).
[0070] The trajectory of the drone in this experiment under the VICON system is as follows Figure 3 As shown, the red circle is an obstacle, and the blue circle is the target arrival signal timing logic task assigned to the drone. It can be seen that the safety of the system is met, that is, The corresponding h(x)(h g,1,1 ,h g,2,1 ,h g,3,1 ),γ(t)(γ 1,1 ,γ 2,1 ,γ 3,1 ) and the control barrier function Respectively Figure 4 , 5 As shown. It can be seen that when the UAV is completing the obstacle avoidance task, even if u cbf,s in u s The UAV system can still ensure the forward invariance of the system control obstacle function through online adjustment of parameters. Based on the image of γ(t), it can be seen that the target mission of the UAV has been completed, that is, The speed control command u of the drone is as follows Figure 6 shown.
[0071] Through the above experiments, the effectiveness of the online parameter adjustment method of the UAV system controller provided by the present invention is further verified. By adjusting the relevant parameters in the system controller online, the UAV can better complete signal timing logic tasks with complex requirements under the disturbance of unknown environment or limited control input conditions.
[0072] The description of the above specification and embodiments is used to explain the protection scope of the present invention, but does not constitute a limitation on the protection scope of the present invention. Through the enlightenment of the present invention or the above embodiments, ordinary technicians in this field can obtain modifications, equivalent substitutions or other improvements to the embodiments of the present invention or part of the technical features thereof through logical analysis, reasoning or limited experiments, which should be included in the protection scope of the present invention.
Claims
1. A method for online adjustment of parameters of an unmanned aerial vehicle system controller, wherein the unmanned aerial vehicle completes a signal timing logic task under the control of the system controller; the system controller includes an obstacle avoidance controller generated based on an artificial potential field function and a target arrival controller generated based on a time-varying robust control obstacle function; wherein the method is characterized in that: In the target arrival controller, the time-varying robust control obstacle function includes a predicate function corresponding to the target area and constraint parameters determined based on the signal sequential logic task; During the operation of the drone, the constraint parameters are updated in real time through the following steps: Step 1: Obtain the predicate function and robustness parameters corresponding to the target area; Step 2: Initialize time parameters and constraint parameters based on the nature of the signal timing logic task currently being performed by the UAV; Step 3: When the time-varying robust control barrier function is a non-positive number, updating the constraint parameters according to a preset updating rule; Step 4: within a preset period, determine whether the time-varying robust control barrier function corresponding to the constraint parameter is less than or equal to 0, if yes, return to step 3 to continue updating the constraint parameter, if not, keep the constraint parameter obtained after the last update; Among them, the time-varying robust control barrier function is given by In other words, in the proposition φ s The kth time-varying robust control barrier function is The predicate function corresponding to the target area is h g,s,k (x), the constraint parameter is γ s,k (t), and among them,c s,k (t)=(γ s,k,0 -c s,k,∞ )exp(-I s,k (t-t0))+γ s,k,∞ ; The initial state of the drone is x0=x(t0), let Then γ s,k (t) Initialize and update the constraint parameters in step 3 based on the following rules: In the above rules, ρ s,k is the robustness parameter, ρ s,k >0; t0 is for each proposition φ s The initial moment, is the time parameter, Represents the predicate function h corresponding to the predicate logic μ g,s,k (x) In Proposition F [a,b] In ψ, Represents the predicate function h corresponding to the predicate logic μ g,s,k (x) In proposition g [a,b] In ψ, ψ is the area of the signal timing logic task currently performed by the UAV; Indicated in When the predicate function h g,s,k The supremum of (x), r s,k is the robustness coefficient for proposition completion, r s,k ∈R >0 , R >0 is a pre-set set of positive real numbers; Δ s,k To update the restriction parameters, Δ s,k ∈(0,γ s,k,∞ ).
2. The method for online adjustment of parameters of a drone system controller according to claim 1, characterized in that In step 2, the time parameters are initialized as follows: s =φ1, t0 = 0; when φ s When s≥2, t0=b s-1 .
3. The method for online adjustment of parameters of a drone system controller as claimed in claim 2, characterized in that In step 3, when the current time t is less than the time parameter and When t is less than or equal to 0, new =t, Update γ based on the update rule s,k,0 , juxtapose h g,s,k (x0) = h g,s,k (x), at this time And according to γ s,k (t) = (γ s,k,0 -γ s,k,∞ )exp(-I s,k (tt new ))+γ s,k,∞ Calculate γ s,k (t); where s,k Greater than or equal to the preset l max When s,k = l max .
4. The method for online adjustment of parameters of a drone system controller as claimed in claim 3, characterized in that In step 3, when the current time t is greater than or equal to the time parameter And b s When (x, t) is less than or equal to 0, let t new =t, update γ based on the update rule s,k,0 , juxtapose h g,s,k (x0) = h g,s,k (x), according to γ s,k (t) = (γ s,k,0 -γ s,s,∞ )exp(-l max (tt new ))+γ s,k,∞ Calculate γ s,k (t).
5. The method for online adjustment of parameters of a drone system controller as claimed in claim 4, characterized in that: In the constraint parameter updating process, if If it is greater than 0, the γ obtained after the last update is kept s,k (t).
6. The method for online adjustment of parameters of a drone system controller as claimed in claim 1, characterized in that: The obstacle avoidance controller is generated based on an artificial potential field function; For each proposition φ s , whose artificial potential field function is defined as U s (x) = U attr,s (x)+∑ k U rep,s,k (x); where U attr,s (x) is the gravitational potential field, For the UAV in the proposition φ s The target state is π o,s,k is the set of obstacles perceived by the drone at time t The predicate function h of the kth obstacle in o,s,k The zero level set of (x(t)), With r o,s,k is φ s The center and radius of the kth obstacle in U rep,s,k (x) is φ s The repulsive potential field of the kth obstacle in is, The choice satisfies And function The zero-level set of k does not intersect, s , η s,k is a positive scalar parameter; The obstacle avoidance controller u cpf,s Generated by solving the following quadratic programming problem: Among them, c s To adjust the obstacle avoidance rate parameter, c s >0; Based on the solution of the above quadratic programming problem, the obstacle avoidance controller u cpf,s In the following form: in, To solve the above quadratic programming problem, we obtain the optimal controller; C g , C d is the threshold of gradient and distance, C g >0,C d > 0; δ is bounded perturbation, δ∈R m ; C g , C d and δ satisfy the following conditions: ||g(x)δ||≤C δ , and the set In each time interval t∈[a s ,b s ] is not an invariant set.
7. The method for online adjustment of parameters of a drone system controller as claimed in claim 6, characterized in that: The target arrival controller is generated based on a time-varying robust control obstacle function; For each proposition φ s , the target reaches the controller u cbf,s Generated by solving the following quadratic programming problem: Where Q∈R m×m is a positive definite matrix, α s :(-∞,+∞)→(-∞,+∞) is the expansion Class function, satisfying α s (0) = 0 and strictly monotonically increasing, is the time-varying robust control barrier function, Where η>
0.
8. The method for online adjustment of parameters of a drone system controller as claimed in claim 7, characterized in that: The system controller s Including the obstacle avoidance controller u cpf,s and the target reaches the controller u cbf,s , which is of the following form: s =λ s (x,h ob,s (x,t))u cbf,s +(1-λ s (x,h ob,s (x,t)))u cpf,s ; Among them, h ob,s (x) is the smooth lower approximation of the predicate function of all obstacles perceived by the drone, η ob >0,λ s (x,h ob,s (x) is defined as Ensure s (x,h ob,s (x,t))∈[0,1],β s is the decision function λ s (x,h ob,s (x,t)) decay rate constant.
9. The method for online adjustment of parameters of a drone system controller as claimed in claim 8, characterized in that: In step 4, for any k, if there exists a time In the time interval The constraint parameter γ s,k (t) No update occurred and in the time interval Inner s,k (t)>0, determine each sequential logic task φ s All completed.
Citation Information
Patent Citations
UPPAAL-based unmanned aerial vehicle system safety formalized modeling verification method
CN114297917A
Path planning and formation control method for multi-unmanned vehicle system of sequential logic task
CN115047861A
Unmanned aerial vehicle task path planning method, device and equipment and storage medium
CN116088583A
Control of multi-drone fleets with temporal logic objectives
US20200348696A1
Cited By
Unmanned aerial vehicle signal sequential logic task motion planning method based on sequential decomposition
CN119987398A
Complex system emission control logic simulation and verification method
CN121596773A
