The following documents are incorporated herein by reference as if fully set forth: European Patent Application No. 19 196 435.2, filed Sep. 10, 2019.
The invention relates to a method of controlling an actuator system comprising a plurality of k actuators, preferably for controlling a multiactuator aerial vehicle, wherein said actuators are preferably devised as individual propulsion units of the multiactuator aerial vehicle.
The invention also relates to an aircraft, in particular electrically propelled VTOL (vertical take-off and landing) aircraft, comprising an actuator system with a plurality of k actuators, wherein said actuators are devised as individual propulsion units of the aircraft.
In overly determined actuator systems, e.g. multiactuator aerial vehicles (MAVs), wherein each actuator may be identified as a propulsion unit of the aircraft, there are different possibilities to achieve given tasks, such as a given flight direction. The given task can be allocated in different ways/portions to the different actuators. In other words: each one of the actuators receives a corresponding control signal to control its operation, so that the joint operation of all actuators can achieve said given task (e.g., fly in a desired direction). One way to do this has been described in German application DE 10 2019 101 903, filed by the present applicant.
So far, no allocation method is known from the prior art which considers the actuators' health status/characteristics. Actuators, e.g. electric motors for MAVs, can provide continuous power for a substantially unlimited time, i.e., continuously during a given mission, or in case of emergency or failure scenario until a safe landing of the MAV, whereas if more power is needed, they can provide a peak power, however only for a certain amount of time, before they overheat. This can lead to degradation or loss of motors. In consequence, this can lead to a higher power demand on the remaining motors, which implies further failures of the remaining motors due to an ever increasing overload cascade.
It is the object of the present invention to provide an allocation method for overly determined actuator systems in the form of a method of controlling an actuator system comprising a plurality of k actuators, which allocates a given task for the overall system to the multiple actuators, considering the actuators characteristics in terms of available physical capacity in a specific timeframe, thus avoiding the above-described degradation and overload situation, in particular in connection with a multiactuator aerial vehicles (MAV).
The object is achieved by a method of controlling an actuator system and by an aircraft (or MAV) having one or more of the features described herein. Advantageous further embodiments are described below and in the claims.
According to the present invention, there is proposed a method of controlling an actuator system comprising a plurality of k actuators, preferably for controlling a multiactuator aerial vehicle, wherein said actuators are preferably devised as individual propulsion units of the multiactuator aerial vehicle. Each of said actuators, during operation, receives a control input (signal) ui, wherein index i (i=1, . . . , k) denotes a particular (or given) actuator. This control input ui is determined depending on a weight matrix W comprising a weighting factor wi for each of the actuators and depending on at least a physical maximum control limit uimax for each of the actuators. Said weighting factors wi and/or physical maximum control limits uimax are actively changed during operation of the actuator system if a first comparison, for at least some of the actuators, of said control input ui or a function ƒi(ui) thereof with a set first threshold value yields that said control input ui or said function ƒi(ui) thereof exceeds said set first threshold value, which set first threshold value preferably will be different for each actuator. Said first comparison is repeated over time during operation of the actuator system, preferably at regular time intervals. A new control input ui is determined from the adjusted weighting factor wi and/or the adjusted physical maximum control limit uimax and applied to the actuators, thus considering the actuators' characteristics in terms of available physical capacity in a specific timeframe.
Whenever the present application refers to “applying a new control input ui which is determined from the adjusted weighting factor wi and/or the adjusted physical maximum control limit uimax to the actuators”, or the like, it shall be understood that a corresponding control input ui is applied to a corresponding actuator i, which control input ui is determined based on weighting factor wi and/or the adjusted physical maximum control limit uimax for that actuator.
Further, according to the present invention, there is proposed an aircraft or MAV, in particular an electrically propelled VTOL aircraft (eVTOL), comprising: an actuator system comprising a plurality of k actuators, wherein said actuators are devised as individual propulsion units of the aircraft, wherein each of said actuators, during operation, is adapted to receive, from at least one flight control unit or controller, a control input ui, wherein index i denotes a particular actuator, wherein said control input ui is determined by at least one computer algorithm performed on said at least one flight control unit, preferably on board the aircraft and/or in real time, wherein the at least one flight control unit, by means of said algorithm, is adapted to perform the method according to the invention and to supply said (new) control input ui to said actuators (i.e., to each corresponding actuator i).
For simplicity, the quantities ui, uimax, wi etc. (wherein i=1, . . . , k) will hereinafter alternatively be expressed as u, umax, w, . . . , which are vectors with components ui, uimax, wi, respectively.
The (allocation) method according to the invention can be applied for a wide class of systems, e.g. aircraft, robots, under-actuated and/or overly determined systems, etc. For better understanding, the equations of motion of such systems, which can be derived using the Newton-Euler principle or the Lagrange method are depicted as follows:
M(x){umlaut over (x)}+c(x,{dot over (x)})+g(x)+G(x)up=ƒext, (Equation 1)
where x∈n is an n-dimensional configuration vector of the system, e.g. positions and rotations in 3D, M(x)∈n=n is the state dependent generalized moment of inertia, c(x,{dot over (x)})∈n is the state dependent Coriolis forces, g(x)∈n stand for the gravitational forces and ƒext∈n are the external forces and torques, e.g. due to aerodynamics, physical contact, etc. A pseudo control input up∈m can be defined, which is used to control the (actuator) system. This pseudo-control input (which equals a collective thrust and torques acting on the aircraft owing to its actuators (propulsion units) in Multiactuator Aerial Vehicles) enters into the system dynamics as given by (Equation 1), after modification with a so-called control input matrix G(x)∈n×m. This matrix contains the information of, e.g., under-actuation, where the system is said to be under-actuated if Rank (G(x))<n, as known to the skilled person.
Allocation happens between the actual control input u∈k, i.e., the input values ui defined before, and the pseudo control input up∈m (vector with components upj with j={1, . . . , m}) via
u
p
=Du, (Equation 2)
where is defined D∈m×k as allocation matrix.
Note that a system can be both under-actuated and overly determined, i.e., in case of k>m>n or Rank (G(x)D)<n.
Using state feedback control laws (which for MAV-VTOL comprise, e.g., attitude, altitude, position/velocity control, path/trajectory tracking etc.) based on the system dynamics described in Equation 1, one can compute a desired up. This, however, needs to be distributed to the physical actuators using actual control inputs u. Hence, a sort of inverse matrix computation is needed in order to compute u from the desired up. This is depicted by
u=D
−1
u
p. (Equation 3)
In the present context, this inversion is done by considering a weight matrix WRk×k, where generally W=diag{w1,w2, . . . , wk} (the wi defined before) and the physical limits of each actuator, e.g. umin∈k and umax∈k, can be considered in this inversion. This implies that
D
−1
=D
−1(W,umin,umax)∈k×m (Equation 4)
wherein it should be recalled that actually D=D(uumin,umax) or at least D=D(umax).
Preferably, the aircraft further comprises sensors for providing data representative of a physical and operational state of the aircraft, wherein the least one flight control unit is devised to determine said pseudo control input up from said sensor data.
In a corresponding preferred embodiment of the method according to the present invention, said control input ui can be determined based on a pseudo control input up, wherein up=Du, D being an allocation matrix dependent on at least uimax, wherein determining u involves solving an equation u=D−1up, D−1 being defined as D−1(W,umax), W being said weight matrix, wherein the inverse allocation matrix D−1 is adjusted according to the changed values of W and umax; and wherein the new control input ui is determined from the adjusted inverse allocation matrix D−1 and applied to the actuators.
Additionally, umin can be considered as well, which can comprise a lower physical control limit uimin of each actuator. In that case, D−1 could be defined as
D
−1
=D
−1(W,umin,umax)
W being said weight matrix, wherein the inverse allocation matrix D−1 is adjusted according to the changed values of W, umin and umax; and wherein the new control input ui is determined from the adjusted inverse allocation matrix D−1 and applied to the actuators.
The method does actively change W, umin, umax or at least W, umax and hence can reshape D and D−1, in case one or more actuators of the system is/are close to their physical limits. By doing so, a given actuator can be protected (e.g. from overheating) and ergo the overall system. To achieve this, no feedback data from the actuators to the flight control unit is required, but if available and applicable such data could be used as well. In such case, a feedback from the actuators, e.g. their states (RPM, health status, frequency response, temperature, voltage, current, etc) can be used in order to cross-check if any actuator is in saturation, unhealthy or demanding excessive power levels. This cross-check can improve the quality of detection when the W and umax values shall be changed.
In a preferred embodiment of the method according to the present invention, said first threshold value is defined as a rather soft limit, which is hereinafter referred to as available control limit and denoted uavail [u1avail,uiavail, . . . ukavail]∈k, where uiavail is the available control limit for the i-th actuator. See appended
Note that the values uiavail for each actuator are not necessarily static values, they can also dynamically change e.g. based on actuator temperature, demanded thrust and torques (up) etc.
Therefore, in a preferred embodiment of the method according to the present invention, said first threshold value comprises an available control limit for each actuator, said available control limit being a control input at which a given actuator can function continuously without overload.
Furthermore, for each actuator, e.g. for the i-th one, one can define ƒi(*), which is a function of*, where*={ui,uimin,uimax,uiavail}. These functions, namely ƒi(ui), ƒi(uimin), ƒi(uimax), ƒi(uiavail) can be:
Preferably, the system under consideration, e.g. the aircraft, comprises sensor means in connection with the actuators, which sensor means are arranged and devised for measuring values corresponding to ƒi(*), and to provide said measured values to the flight control unit in order to enable the flight control unit to perform the method in accordance with the present invention.
For an aircraft,
These values are known, e.g., from the manufacturer of the actuators, or can be set based on simulations, experiments, experience, etc.
In a preferred embodiment of the method according to the present invention, one can define a timer or counter, denoted ticd, which represents a cool-down timer for the i-th actuator. Its initial value is denoted ticd,init, e.g., ticd,init=10 s (without limitation). This initial value can also be known before, e.g., from the manufacturer of the actuator, or decided based on simulations, experiments, experience, etc.
In preferred embodiment of the method according to the present invention, one can define other timers (counters) and corresponding time limits (counter thresholds):
In this context, instead of timers or counters (timax, tiavail) one can use other values as function of time, e.g. temperature, power, etc. In this case, reshaping and reweighting will be done directly by comparing temperature measurements or power computations, if they are available.
In preferred embodiment of the method according to the present invention, a first counter, e.g., tiavail as defined above, is augmented whenever said first comparison yields that said control input u or said function ƒ(u) thereof exceeds said first set threshold value, e.g., ƒi(uiavail), and wherein at least matrix W is adjusted based on a current value of said first counter, preferably based on a weighting function, a value of which weighting function is dependent on said current value of said first counter. Preferably, W is adjusted based on a current value of said first counter only if said first counter does not exceed its threshold (cf. above).
In another preferred embodiment of the method according to the present invention, a second counter, e.g., timax as defined above, is augmented whenever a comparison yields that said control input u or said function ƒ(u) thereof exceeds said corresponding set threshold value, e.g., ƒi(uimax)−∈i, and wherein at least matrix W is adjusted based on a current value of said second counter, preferably based on a weighting function, a value of which weighting function is dependent on said current value of said second counter. Preferably, W is adjusted based on a current value of said second counter only if said second counter does not exceed its threshold (cf. above).
For instance, said weighting function can be a sigmoid-like or any other preferably continuous function of said current value of said first counter, e.g., a function defined as “1-sigmoid”, said weighting function most preferably ranging between values from 0 to 1, so that a given actuator is either considered fully (1), excluded from allocation (0), or considered with a weight between 0 and 1, depending on a current value of said first counter. This takes into consideration that the actuator in question has been functioning above its “available” limit for some time. Preferably, the value of the weighting function decreases for increasing values of said first or second counter.
In preferred embodiment of the method according to the present invention, the value for umax, i.e. uimax is adjusted to a lower value, i.e, decreased, said lower value preferably being a control input at which a given actuator can function continuously without overload (said “available” limit), if said first counter exceeds a set first counter threshold, e.g.,
In another preferred embodiment of the method according to the present invention, at least one of Wand umax (optionally also umin) is actively changed during operation of the actuator system based on a second comparison, for at least some of the actuators, of the control input u or a function ƒ(u) thereof with at least a second set threshold value, e.g., ƒimax(uimax), for said control input u or said function ƒ(u) thereof, if said second comparison yields that said control input u or said function ƒ(u) thereof exceeds said second set threshold value. Furthermore, it is checked if a second counter, e.g. timax, which second counter is augmented whenever said second comparison yields that said control input u or said function ƒ(u) thereof exceeds said second set threshold value, exceeds a set second counter threshold, e.g.,
In yet another embodiment of the method according to the present invention, said second set threshold value can be lowered by a safety margin. In other words, the above-defined second comparison results in an increase of said second counter if ƒi(ui)≥ƒimax−∈i, wherein ∈i can be a (small) heuristically set number. This shall protect the corresponding actuator from overheating/overloading when functioning at or close to its physical limit.
In another preferred embodiment of the method according to the present invention, if either said first counter exceeds said set first counter threshold (e.g., tiavail≥
In yet another preferred embodiment of the method according to the present invention, based on a third comparison, for at least some of the actuators, of the control input u or a function ƒ(u) thereof with said first set threshold value and of said third counter with said third set counter threshold, if said third comparison yields that said control input u or said function ƒ(u) thereof does not exceed said first set threshold value, e.g., ƒi(ui)≤(uiavail), and that said third counter has its initial value, e.g., ticd=ticd,init, then at least wi is set to a default value, preferably wi being equal to unity (wi=1), said third comparison being repeated over time during operation of the actuator system, preferably at regular time intervals. This defines normal operating conditions of the actuator system.
In another embodiment of the method according to the present invention, if said third comparison yields that said control input u or said function ƒ(u) thereof does not exceed said first set threshold value, e.g., ƒi(ui)≤ƒi(uiavail), and that said third counter has its initial value (e.g., ticd=ticd,init), said first counter (e.g., tiavail) is decreased and/or said second counter (e.g., timax) is decreased. This accounts for normal operation of a given actuator, which may have an effect on the adopted value for wi.
In another embodiment of the method according to the present invention, if a subsequent comparison yields that said first counter is below a first lower bound, e.g. zero, or that said second counter is below a second lower bound, e.g. zero, said first counter or said second counter, respectively, is reset to an initial value thereof. This makes sure that said first and second counters are lower-bounded.
In yet another embodiment of the method according to the present invention, if both said first counter and said second counter have their respective initial values, then at least wi is set to a default value, preferably wi being equal to unity. This defines normal operating conditions of the actuator system.
In another embodiment of the method according to the present invention, if up is close to its physical bounds (e.g., maximum thrust and torques are commanded) or too many actuators are in saturation (e.g. ui>uavail, for i={1,2, . . . h} and h<k), then re-weighting functions can be ignored or thresholds (
It will be evident for the skilled person that all counters defined above can alternatively be operated inversely, i.e., decreased instead of increased, or vice versa.
It will be evident for the skilled person that all mentioned time intervals preferably correspond to a same or common time interval. Furthermore, preferably all counters mentioned above are increased/decreased by a common counter interval, which may correspond to a time step, e.g. within one control loop cycle.
The gist of the invention, in terms of a highly preferred embodiment, can be summed up in stepwise fashion as follows:
1. The weight matrix is adjusted when ƒ(ui) is greater than ƒ(uiavail) or ƒ(uimax). In that case, relevant counters (tiavail, timax) start increasing. These counters could also be temperature measurements or the like.
2. A maximum actuator limit known to the controller, uimax, is reduced to uiavail, when those counters (or temperature measurements) hit their own limits (
3. When the cool-down phase is finished, all the counters and maximum control limits are set to initial values, i.e., nominal condition.
4. Logic repeats.
5. This logic would be used only when rank(D)>d, e.g.; d=4 and up>upmin.
Further features and advantages of the invention will now be described with reference to the appended drawings, which illustrate specific embodiments of the invention.
Flight control unit 2 comprises an algorithm 2a (i.e., comprises computing means that perform said algorithm 2a) which receives said desired control input up and which performs the method according to the present invention (or an embodiment thereof) in order to weight and reshape the actuator allocation. The output of the corresponding calculations is provided to actuator control means 2b, which provide the actual control input ui to the individual actuators 3. Data from sensors 4 can be used to enhance performance of the algorithm, e.g., by providing control feedback—however, this is not required.
In
The algorithm of
The procedure REWEIGHTRESHAPEALLOCATION comprises, in line 7, a comparison, for each one of the actuators, of ƒi(ui) with both ƒi(uimin) and ƒi(uiavail), the latter being a first threshold. If said first threshold is not exceeded, and the cool-down timer ticd still has its initial value, then wi is set to 1 (unity weight), which is the nominal or default condition: the corresponding actuator is weighted normally. The counters tiavail and timax, as defined before, are decreased, and are set to zero in case they should become negative. In line 15, there is another comparison of ƒi(ui) with ƒi(uiavail). In case ƒi(ui)>ƒi(uiavail), a corresponding further timer is increased, which accounts for the time a given actuator is operated above its available control limit. Then, in line 17, there is another comparison of ƒi(ui) with ƒi(uimax)−∈i, which corresponds to operation at maximum control limit minus a heuristically set safety margin. In case ƒi(ui)>ƒi(uimax)−∈i, a corresponding further timer is increased, which accounts for the time a given actuator is operated at or close to its maximum limit. If, in line 19, both counters tiavail and timax are still zero, we have nominal conditions, and wi is set to 1 (unity weight). Otherwise it is checked, beginning in line 22, whether or not at least one of counters tiavail and timax has reached its maximum or upper threshold value, which indicates that a given actuator has been operated above the available limit ƒi(uiavail) for too long. If said check is positive, the highest possible control limit for that actuator is reduced, uimax←uiavail, which is also referred to as reshaping. In line 25, the corresponding cool-down timer or counter is started (decreased) in order to be able to end the reshaping after a pre-set amount of time. Lines 26 through 30 codify an end of cooldown, if the timer has reached zero. If, however, counter timax is not zero, i.e. there has been operation at or close to the physical control limit, but neither tiavail and timax has reached its maximum or threshold value (line 31), then wi is set to a value derived from a weighting function (wf1, e.g. a sigmoid or sigmoid-like function) with argument timax, which yields a value for wi between 0 and 1. And if timax is zero but the counter tiavail is not zero, i.e., there has been operation above the available control limit, but neither tiavail and timax has reached its maximum or threshold value (line 31), then wi is set to a value derived from another weighting function (wf2, e.g. a sigmoid or a sigmoid-like function) with argument tiavail, which yields a value for wi between 0 and 1. The two weighting functions wf1 and wf2 may have the same logic.
Referring back to
Number | Date | Country | Kind |
---|---|---|---|
19196435.2 | Sep 2019 | EP | regional |