Method and system for controlling a flying wing
09690299 · 2017-06-27
Assignee
Inventors
Cpc classification
F03B17/06
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F05B2210/16
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F05B2240/97
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F05B2240/9174
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
Y02E10/728
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
F05B2240/917
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
Y02E10/20
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
Y02E10/72
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
F03D13/22
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
Y02E10/30
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
F03D9/30
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
Y02E10/70
GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
F03D5/00
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F03D9/25
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F03D5/005
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
International classification
F03D5/00
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F03D9/25
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
Abstract
The invention relates to a method for control of a flying wing. The flying wing is arranged to be controlled to move along a predetermined trajectory by means of a fluid stream passing a wing of the flying wing. The flying wing comprises at least one control surface for controlling the movement of the flying wing along the predetermined trajectory. The flying wing is positioned in a reference frame where the x-axis is directed horizontally along a level L above which the flying wing moves, the y-axis is perpendicular to the x-axis in a vertical direction and the z-axis is perpendicular to the x-axis along the level L in a direction along the principal direction of the fluid stream. The invention further relates to a system comprising a flying wing and a computer-readable medium for use with a flying wing.
Claims
1. A method for control of a flying wing, the flying wing being arranged to be controlled to move along a predetermined trajectory by means of a fluid stream passing the flying wing; the flying wing comprising a wing and at least one control surface for controlling a movement of the flying wing along the predetermined trajectory, the flying wing being positioned in a reference system where the x-axis is directed horizontally along a level L above which the flying wing moves, the y-axis is perpendicular to the x-axis in a vertical direction and the z-axis is perpendicular to the x-axis along the level L in a direction along the principal direction of the fluid stream, the flying wing being arranged to be attached to said level L by means of a tether attached to a structure positioned at said level L, wherein the control of the flying wing is arranged to be performed using a horizontal position of the flying wing, a vertical position of the flying wing, a heading of the flying wing and a yaw rate of the flying wing, where the horizontal position, the vertical position, the heading and the yaw rate can be measured or modelled, wherein the method uses as measured input values the heading, pressure to obtain measured vertical position, yaw rate and speed of the flying wing, wherein the method comprises: controlling the movement of the flying wing along the predetermined trajectory during a sensor feedback phase using measured values of heading, vertical position and yaw rate and modelled values of horizontal position, switching between said sensor feedback phase and a model feedback phase after a predetermined distance along the predetermined trajectory has been traversed and when a deviation between the measured value of the vertical position and a modelled value of the vertical position is below a threshold value, and controlling the movement of the flying wing along the predetermined trajectory during said model feedback phase using modelled values of heading, vertical position, horizontal position and yaw rate.
2. The method of claim 1, wherein the sensor feedback phase of the method comprises: continuously updating the heading by integrating the measured yaw rate, iteratively adapting the heading based on the measured vertical position after a predetermined distance along the predetermined trajectory has been traversed, iteratively adapting the yaw rate based on the measured vertical position after a predetermined distance along the predetermined trajectory has been traversed, calculating a modelled adaptation of the yaw rate in order to prepare for the transition between the sensor feedback phase and the model feedback phase, calculating the flying wing's modelled horizontal position and modelled vertical position by dead reckoning using the measured speed and measured heading of the flying wing, iteratively adapting the modelled horizontal position of the flying wing based on the average speed of a first part of the predetermined trajectory and the average speed of a second part of the predetermined trajectory, iteratively adapting a horizontal drift speed based on the average speed of a first part of the predetermined trajectory and the average speed of a second part of the predetermined trajectory, iteratively adapting the modelled vertical position based on the difference between the modelled vertical position and the measured vertical position, and iteratively adapting a vertical drift speed based on the difference between the modelled vertical position and the measured vertical position.
3. The method of claim 1, wherein the model feedback phase of the method comprises: continuously calculating the modelled heading by integrating the modelled yaw rate, iteratively adapting the modelled heading based on the difference between the measured vertical average position and the modelled vertical average position after a predetermined distance along the predetermined trajectory has been traversed, iteratively adapting the modelled yaw rate based on the difference between the measured vertical position and the modelled vertical position after a predetermined distance along the predetermined trajectory has been traversed, calculating the flying wing's modelled horizontal position and modelled vertical position by dead reckoning using the measured speed and measured heading of the flying wing, iteratively adapting the modelled horizontal position of the flying wing based on the average speed of a first part of the predetermined trajectory and the average speed of a second part of the predetermined trajectory, iteratively adapting a horizontal drift speed based on the average speed of a first part of the predetermined trajectory and the average speed of a second part of the predetermined trajectory, iteratively adapting the modelled vertical position based on the difference between the modelled vertical position and the measured vertical position, and iteratively adapting a vertical drift speed based on the difference between the modelled vertical position and the measured vertical position.
4. The method of claim 1, wherein the vertical position and the horizontal position are Cartesian positions or the vertical position and the horizontal position are a vertical angle and a horizontal angle respectively.
5. The method of claim 1, wherein the heading is obtained from a heading sensor, the pressure is obtained from a pressure sensor, the yaw rate is obtained from a yaw rate sensor and the speed is obtained from a speed sensor.
6. The method of claim 1, wherein the flying wing comprises a turbine for generating electrical energy by the movement of the flying wing through fluid of the fluid stream and where the flying wing is submerged in the fluid.
7. A system comprising: a flying wing comprising a wing and at least one control surface for controlling the movement of the flying wing along a predetermined trajectory, the flying wing being arranged to move along the predetermined trajectory by means of a fluid stream passing the wing, the flying wing being positioned in a reference system where the x-axis is directed horizontally along a level L above which the flying wing moves, the y-axis is perpendicular to the x-axis in a vertical direction and the z-axis is perpendicular to the x-axis along the level L in a direction along the principal direction of the fluid stream, wherein the system uses measured values of yaw rate, heading and vertical position and a modelled value of horizontal position during a sensor feedback phase of movement along the predetermined trajectory, and modelled values of yaw rate, vertical position, horizontal position and heading during a model feedback phase of movement along the predetermined trajectory for control of the flying wing, wherein the system uses as measured input values the heading, pressure to obtain measured vertical position, yaw rate and speed of the flying wing during the sensor feedback phase, and wherein said sensor feedback phase is switched to the model feedback phase after a predetermined distance along the predetermined trajectory has been traversed and when a deviation between the measured value of the vertical position and the modelled value of the vertical position is below a threshold value.
8. The system of claim 7, wherein the system further comprises a level pressure sensor located at the level L above which the flying wing moves for measuring the level pressure at said level L, the level pressure being used to improve the calculation of the vertical position of the flying wing over the level L to which it is attached.
9. The system of claim 7, wherein the flying wing is arranged to be attached to said level L by means of a tether attached to a structure positioned at said level L.
10. The system of claim 7, wherein the heading is obtained from a heading sensor, the pressure is obtained from a pressure sensor, the yaw rate is obtained from a yaw rate sensor and the speed is obtained from a speed sensor.
11. The system of claim 10, wherein the heading sensor is an accelerometer, the yaw rate sensor is a gyroscope, the pressure sensor measures a wing fluid pressure at a surface of the flying wing and the speed sensor is one of a turbine configured to provide information on revolution rate thereof, an electric current meter or a pressure based meter.
12. The system of claim 7, wherein the flying wing comprises a turbine for generating electrical energy by the movement of the flying wing through fluid of the fluid stream and where the flying wing is submerged in the fluid.
13. A non-transitory computer-readable medium for use with a flying wing having, said computer-readable medium having computer executable instructions stored therein for performing the method of claim 1.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1)
(2)
(3)
(4)
DETAILED DESCRIPTION OF THE INVENTION
(5) An overview of a system 1 according to the invention is shown in
(6) The flying wing 2 further comprises sensors located on or inside the flying wing 2. The sensors from which the flying wing 2 receives input signals are a heading sensor, a pressure sensor, a yaw rate sensor and a speed sensor. The input signals are transmitted to a control system which comprises a computer-readable medium having computer executable instructions for performing the method according to the invention. The computer-readable medium may be in the form of an integrated circuit or non-volatile memories such as a hard disk drive, flash memory or ROM. The computer-readable medium forms part of the overall control system which may comprise additional parts. The method is implemented on the computer-readable medium using any suitable numeric methods.
(7) In
(8)
(9)
(10) The structure 9 illustrated in
(11) From
(12) In
(13) The flying wing 2 receives the following input values received from sensors located on or in the flying wing 2: heading , pressure p used to obtain measured vertical Cartesian position y, yaw rate {dot over ()} and speed . The heading is obtained from a heading sensor, the pressure p is obtained from a pressure sensor, the yaw rate {dot over ()} is obtained from a yaw rate sensor and the speed is obtained from a speed sensor. Different gyroscopes can be used for measuring the yaw rate of the flying wing 2. The pressure sensor or sensors used measures a wing fluid pressure at a surface of the flying wing 2. The wing fluid pressure is used for calculating the vertical Cartesian position of the flying wing 2 over a level L above which the flying wing 2 moves. An accelerometer is used for measuring the heading of the flying wing 2. The speed is measured for instance by using the number of revolutions per second of a turbine 5 attached to the flying wing 2 or by a current meter. The speed may also be measured using pressure based sensors. The system 1 may further comprise an additional pressure sensor used to measure a level pressure of the level L over which the flying wing 2 moves. The additional pressure sensor may be located on the structure 9 or on the level L over which the flying wing 2 moves and may be used to increase the degree of accuracy of the calculation of the vertical position of the flying wing 2.
(14) indicates the heading of the flying wing 2, i.e. the direction in which the front of the flying wing is pointing. =0 means that the flying wing 2 is directed directly upwards, =90 means that the flying wing 2 is directed directly to the left etc. This is indicated in the reference frame of
(15) Different reference frames can of course be used, for instance the z-axis indicating the direction of the fluid current may be positive in the opposite direction than the one shown in
(16)
(17) The flying wing system 1 and the method for controlling the flying wing 2 according to the invention can be used both on land and submerged under water.
(18) Variables without subscript m indicate measured values, variables with subscript m indicates modelled values. A variable with the accent {dot over ( )}(dot) means the derivative of that variable with respect to time. For instance {dot over ()} means the derivate of with respect to time. A variable with the accent {umlaut over ( )}(double dot) means the second derivative of that variable with respect to time. For instance {umlaut over ()} means the second derivate of with respect to time.
(19) In the sensor feedback phase the flying wing 2 may be controlled using a modelled horizontal Cartesian position x.sub.m, a measured vertical Cartesian position y obtained from pressure p, a measured heading and a measured yaw rate {dot over ()}.
(20) An initial heading .sub.intial of the flying wing 2 is measured from a heading sensor located in the flying wing 2 at the start of the sensor feedback phase.
(21) The heading is continuously calculated by integrating the yaw rate {dot over ()} from a yaw rate sensor.
={dot over ()}dt(1)
(22) To compensate for errors in the heading the heading is iteratively adapted based on the measured vertical Cartesian position y (calculated from p) after a predetermined distance along the predetermined trajectory has been traversed by adding a term .sub.adaptation to equation 1.
={dot over ()}dt+.sub.adaptation(2)
wherein
.sub.adaptation(n.sub.1)=.sub.adaptation(n.sub.11)+k.sub.1(
.sub.adaptation(0)=.sub.initial
where
(23) To compensate for errors in the yaw rate sensor the yaw rate {dot over ()} is iteratively adapted based on the measured vertical Cartesian position y after a predetermined distance along the predetermined trajectory has been traversed by adding a term {dot over ()}.sub.adaptation to equation 2.
=({dot over ()}+{dot over ()}.sub.adaptation)dt+.sub.adaptation(3)
wherein
(24)
where
(25) At the same time as the adaptation {dot over ()}.sub.adaptation is calculated, a modelled adaptation of the yaw rate {dot over ()}.sub.m,adaptation is calculated in order to prepare for the transition between the sensor feedback phase and the model feedback phase.
(26)
(27) The term (
(28)
(29) The modelled yaw rate is iteratively adapted based on the difference between the measured vertical Cartesian position and the modelled vertical Cartesian position (
(30) The flying wing's 2 modelled horizontal Cartesian position x.sub.m and modelled vertical Cartesian position y.sub.m are calculated by dead reckoning using the measured speed and measured heading of the flying wing 2
x.sub.m={dot over (x)}.sub.mdt,{dot over (x)}.sub.m= cos (4)
y.sub.m={dot over (y)}.sub.mdt,{dot over (y)}.sub.m= sin cos (5)
where is the angle between the tether 8 of the flying wing 2 and the z-axis. The term cos compensates for the fact that the flying wing 2 moves on a spherical surface. The addition of cos compensates for that the surface of the sphere is curved in the vertical direction. It is also possible to correct for that the surface of the sphere is curved in the horizontal direction in a similar way. These corrections are not needed in the case the flying wing 2 is moving freely without being attached to a structure 9 with a tether 8. The modelled vertical Cartesian position y.sub.m is prepared for switching to the model feedback phase.
(31) To compensate for that the flying wing 2 may drift away from a central position along the principal direction of the fluid stream 10 the modelled horizontal Cartesian position x.sub.m of the flying wing 2 is iteratively adapted by adding a term x.sub.m,adaptation to equation 4.
x.sub.m={dot over (x)}.sub.mdt+x.sub.m,adaptation(6)
where
x.sub.m,adaptation(n.sub.4)=x.sub.m,adaptation(n.sub.41)+k.sub.4(
x.sub.m,adaptation(0)=0
where
(32) To further adapt the horizontal Cartesian position a horizontal drift speed adaptation {dot over (x)}.sub.m,adaptation is added to equation 6 such that the difference
x.sub.m=({dot over (x)}.sub.m+{dot over (x)}.sub.m,adaptation)dt+x.sub.m,adaptation(7)
where
(33)
where k.sub.5 is a tuning variable which is set to a value that allows for a suitable convergence of the adaptation towards a desired adaptation value and t is the time to complete the predetermined distance along the predetermined trajectory. n.sub.5 is the iteration step.
(34) To compensate for errors in the modelled vertical Cartesian position y.sub.m, the modelled vertical Cartesian position y.sub.m is iteratively adapted based on the difference between the modelled vertical Cartesian position y.sub.m and the measured vertical Cartesian position y by adding a term y.sub.m,adaptation to equation 5.
y.sub.m={dot over (y)}.sub.mdt=y.sub.m,adaptation(8)
where
y.sub.m,adaptation(n.sub.6)=y.sub.m,adaptation(n.sub.61)+k.sub.6(
y.sub.m,adaptation(0)=0
where
(35) To further adapt the vertical Cartesian position a vertical drift speed adaptation {dot over (y)}.sub.m,adaptation is added to equation 8 such that the difference
y.sub.m=({dot over (y)}.sub.m+{dot over (y)}.sub.m,adaptation)dt+y.sub.m,adaptation(9)
where
(36)
where k.sub.7 is a tuning variable which is set to a value that allows for a suitable convergence of the adaptation towards a desired adaptation value and t is the time to complete the predetermined distance along the predetermined trajectory. n.sub.7 is the iteration step.
(37) The control of the flying wing 2 in the sensor feedback phase thus may use the modelled horizontal Cartesian position x.sub.m obtained from equation 7, the measured vertical Cartesian position y (obtained from p), the measured heading and the measured yaw rate {dot over ()}.
(38) In the sensor feedback phase the flying wing 2 may alternatively be controlled using a modelled horizontal angle .sub.m, a measured vertical angle obtained from pressure p, a measured heading and a measured yaw rate {dot over ()}. In this embodiment the horizontal position, both measured and modelled, is indicated as an angle instead of an absolute position. Similarly, the vertical position, both measured and modelled is indicated as an angle.
(39) The measured vertical angle is calculated from the height of the flying wing over the level L above which the flying wing 2 moves. A pressure sensor on the flying wing measures the depth of the flying wing below a surface. The height is then calculated from knowing an actual installation depth D of the flying wing 2, i.e. the depth of the level L above which the flying wing 2 moves, and the depth d of the flying wing 2 below a surface, i.e. the height is calculated from Dd, see
(40)
(41) An initial heading .sub.intial of the flying wing 2 is measured from a heading sensor located in the flying wing 2 at the start of the sensor feedback phase.
(42) The heading is continuously calculated by integrating the yaw rate {dot over ()} from a yaw rate sensor.
={dot over ()}dt(1)
(43) To compensate for errors in the heading the heading is iteratively adapted based on the measured vertical angle (calculated from p) after a predetermined distance along the predetermined trajectory has been traversed by adding a term .sub.adaptation to equation 1.
={dot over ()}dt+.sub.adaptation(2)
wherein
.sub.adaptation(n.sub.1)=.sub.adaptation(n.sub.11)+k.sub.1(
.sub.adaptation(0)=.sub.initial
where
(44) To compensate for errors in the yaw rate sensor the yaw rate {dot over ()} is iteratively adapted based on the measured vertical angle after a predetermined distance along the predetermined trajectory has been traversed by adding a term {dot over ()}.sub.adaptation to equation 2.
=({dot over ()}+{dot over ()}.sub.adaptation)dt+.sub.adaptation(3)
wherein
(45)
where
(46) At the same time as the adaptation {dot over ()}.sub.adaptation is calculated, a modelled adaptation of the yaw rate {dot over ()}.sub.m,adaptation is calculated in order to prepare for the transition between the sensor feedback phase and the model feedback phase.
(47)
(48) The term (
(49)
(50) The modelled yaw rate is iteratively adapted based on the difference between the measured vertical angle and the modelled vertical angle (
(51) The modelled horizontal angle .sub.m, is calculated by taking an infinitesimal step dl in a horizontal direction along the predetermined trajectory over an infinitesimal time step dt.
dl= cos dt
d.sub.m can be calculated from
(52)
(53) As dl is small compared to R, d.sub.m can be approximated as
(54)
from which follows that
(55)
(56) Similarly it follows that the vertical angle is calculated by taking an infinitesimal vertical step dh along the predetermined trajectory over an infinitesimal time step dt.
dh= sin dt
d.sub.m can be calculated from
(57)
(58) As dh is small compared to R, d.sub.m can be approximated as
(59)
from which follows that
(60)
(61) The modelled vertical angle .sub.m is prepared for switching to the model feedback phase.
(62) To compensate for that the flying wing 2 may drift away from a central position along the principal direction of the fluid stream 10 the modelled horizontal angle .sub.m of the flying wing 2 is iteratively adapted by adding a term .sub.m,adaptation to equation 4.
.sub.m={dot over ()}.sub.mdt+.sub.m,adaptation(6)
where
.sub.m,adaptation(n.sub.4)=.sub.m,adaptation(n.sub.41)+k.sub.4(
.sub.m,adaptation(0)=0
where
(63) To further adapt the horizontal position, a horizontal angular drift speed adaptation {dot over ()}.sub.m,adaptation is added to equation 6 such that the difference
.sub.m=({dot over ()}.sub.m+{dot over ()}.sub.m,adaptation)dt+.sub.m,adaptation(7)
where
(64)
where k.sub.5 is a tuning variable which is set to a value that allows for a suitable convergence of the adaptation towards a desired adaptation value and t is the time to complete the predetermined distance along the predetermined trajectory. n.sub.5 is the iteration step.
(65) To compensate for errors in the modelled vertical angle .sub.m, the modelled vertical angle .sub.m is iteratively adapted based on the difference between the modelled vertical angle .sub.m and the measured vertical angle by adding a term .sub.m,adaptation to equation 5.
.sub.m={dot over ()}.sub.mdt+.sub.m,adaptation(8)
where
.sub.m,adaptation(n.sub.6)=.sub.m,adaptation(n.sub.61)+k.sub.6(
.sub.m,adaptation(0)=0
where
(66) To further adapt the vertical angle a vertical angular drift speed adaptation {dot over ()}.sub.m,adaptation is added to equation 8 such that the difference
.sub.m=({dot over ()}.sub.m+{dot over ()}.sub.m,adaptation)dt+.sub.m,adaptation(9)
where
(67)
where k.sub.7 is a tuning variable which is set to a value that allows for a suitable convergence of the adaptation towards a desired adaptation value and t is the time to complete the predetermined distance along the predetermined trajectory. n.sub.7 is the iteration step.
(68) The control of the flying wing 2 in the sensor feedback phase may use the modelled horizontal angle .sub.m obtained from equation 7, the measured vertical angle (obtained from p), the measured heading and the measured yaw rate {dot over ()}.
(69) In order to obtain the advantages mentioned above the flying wing 2 switches to a model feedback phase wherein modelled values of relevant parameters are used for control of the flying wing 2. The switching is done after a predetermined distance along the predetermined trajectory has been traversed and when a difference between a measured value of the vertical Cartesian position y and a modelled value of the vertical Cartesian position y.sub.m is below a threshold value h, i.e. when yy.sub.m<h. The predetermined distance can be at least 1 lap, specifically at least 10 laps, more specifically 20 laps. The threshold value h is between 0.5-5% of the length of the tether 8, specifically between 1-3% of the length of the tether 8 and more specifically 2% of the tether 8 length. If the threshold value h is smaller than 0.5% this could result in that the switching to the model feedback phase occurs to rarely or never takes place. If the difference between the measured value of the vertical Cartesian position y and a modelled value of the vertical Cartesian position y.sub.m is too great the adaptations may cause corrections resulting in unwanted behaviour of the flying wing. If the threshold value h is too great when switching this could result in that the flying wing 2 could end up below the level L over which the flying wing 2 is attached possibly leading to a crash or that the flying wing 2 can reach a vertical position over the level L which is above a secure height for the flying wing. If the flying wing is submerged the flying wing could reach the surface leading to damage to the flying wing. Thus, if the flying wing ends up outside defined vertical boundaries it may be damaged.
(70) The above description of the switching between the sensor feedback phase and the model feedback phase applies also when measured vertical angle and modelled vertical angle .sub.m are used as measured and modelled vertical position. Vertical angles and .sub.m then typically replaces vertical Cartesian position y.
(71) After switching to the model feedback phase the flying wing 2 may be controlled using a modelled horizontal Cartesian position x.sub.m, a modelled vertical Cartesian position y.sub.m, a modelled heading .sub.m and a modelled yaw rate {dot over ()}.sub.m.
(72) The modelled heading .sub.m is continuously calculated by integrating the modelled yaw rate {dot over ()}.sub.m.
.sub.m=({dot over ()}.sub.m+{dot over ()}.sub.m,adaptation)dt+.sub.m,adaptation(10)
where
{dot over ()}.sub.m={umlaut over ()}.sub.mdt(11)
where
(73)
where is a time constant, is the turn gain, i.e. a gain related to the curvature of the spherical surface and is the angle of for instance the rudder of the flying wing 2. The product yields a measure with the unit degrees/second.
(74) The rudder controller controls a servo which sets the angle of the rudder. The aim is to follow a predetermined trajectory placed on the surface of a sphere, where the structure 8 is in the sphere centre and the tether length R is the radius. Given the position of the flying wing 2, a target yaw rate is decided based on the error in position, error in heading angle, the kite speed and the current curvature of the predetermined trajectory. The target yaw rate is put into an internal model control (IMC) controller which calculates the target rudder angle a which is sent to the rudder servo.
(75) The general IMC idea is to invert the yaw rate model. With no model errors a target yaw rate would result in a rudder target which would produce the desired target yaw rate. Model errors are compensated by feeding back the error (measured yaw rate-modelled yaw rate) and compensate the desired target yaw rate. Since the kite dynamic system contains servo delays, the controller also compensates this. The compensation level is a typical design parameter.
(76) .sub.m is iteratively adapted based on the difference between the measured vertical average Cartesian position and the modelled vertical average Cartesian position (
.sub.m,adaptation(n.sub.8)=.sub.m,adaptation(n.sub.81)+k.sub.8(
.sub.m,adaptation(0)=0
where k.sub.8 is a tuning variable which is set to a value that allows for a suitable convergence of the adaptation towards a desired adaptation value and n.sub.8 is the iteration number. The term (
(77)
(78) The modelled yaw rate is iteratively adapted based on the difference between the measured vertical Cartesian position and the modelled vertical Cartesian position (
(79)
(80) This is thus the same adaptation used which was prepared during the sensor feedback phase. The iteration step n.sub.3 may be reset upon switching to the model feedback phase.
(81) The flying wing's 2 modelled horizontal Cartesian position x.sub.m and modelled vertical Cartesian position y.sub.m are calculated by dead reckoning using the measured speed and measured heading of the flying wing 2.
x.sub.m={dot over (x)}.sub.mdt,{dot over (x)}.sub.m= cos (12)
y.sub.m={dot over (y)}.sub.mdt,{dot over (y)}.sub.m= sin cos (13)
where is the angle between the tether 8 of the flying wing 2 and the z-axis. The term cos compensates for the fact that the flying wing 2 moves on a spherical surface.
(82) The addition of cos compensates for that the surface of the sphere is curved in the vertical direction. It is also possible to correct for that the surface of the sphere is curved in the horizontal direction in a similar way. The modelled vertical Cartesian position y.sub.m which was prepared for switching to the model feedback phase is now used.
(83) To compensate for that the flying wing 2 may drift away from a central position along the principal direction of the fluid stream 10 the modelled horizontal Cartesian position x.sub.m of the flying wing 2 is iteratively adapted by adding a term x.sub.m,adaptation to equation 12.
x.sub.m={dot over (x)}.sub.mdt+x.sub.m,adaptation(14)
where
x.sub.m,adaptation(n.sub.4)=x.sub.m,adaptation(n.sub.41)+k.sub.4(
x.sub.m,adaptation(0)=0
where
(84) To further adapt the horizontal Cartesian position a horizontal drift speed adaptation {dot over (x)}.sub.m,adaptation is added to equation 14 such that the difference
x.sub.m=({dot over (x)}.sub.m+{dot over (x)}.sub.m,adaptation)dt+x.sub.m,adaptation(15)
where
(85)
where k.sub.5 is a tuning variable which is set to a value that allows for a suitable convergence of the adaptation towards a desired adaptation value and t is the time to complete the predetermined distance along the predetermined trajectory. n.sub.5 is the iteration step. This is the same adaptation as in the sensor feedback phase. The iteration step n.sub.5 may be reset upon switching to the model feedback phase.
(86) To compensate for errors in the modelled vertical Cartesian position y.sub.m, the modelled vertical Cartesian position y.sub.m is iteratively adapted based on the difference between the modelled vertical Cartesian position y.sub.m and the measured vertical Cartesian position y by adding a term y.sub.m,adaptation to equation 13.
y.sub.m={dot over (y)}.sub.mdt+y.sub.m,adaptation(16)
where
y.sub.m,adaptation(n.sub.6)=y.sub.m,adaptation(n.sub.61)+k.sub.6(
y.sub.m,adaptation(0)=0
where
(87) To further adapt the vertical Cartesian position a vertical drift speed adaptation {dot over (y)}.sub.m,adaptation is added to equation 16 such that the difference
y.sub.m=({dot over (y)}.sub.m+{dot over (y)}.sub.m,adaptation)dt+y.sub.m,adaptation(17)
where
(88)
where k.sub.7 is a tuning variable which is set to a value that allows for a suitable convergence of the adaptation towards a desired adaptation value and t is the time to complete the predetermined distance along the predetermined trajectory. n.sub.7 is the iteration step. This is the same adaptation as in the sensor feedback phase. The iteration step n.sub.7 may be reset upon switching to the model feedback phase.
(89) The control of the flying wing 2 in the model feedback phase thus uses the modelled horizontal Cartesian position x.sub.m obtained from equation 15, the modelled vertical Cartesian position y.sub.m obtained from equation 17, the modelled heading obtained from equation 10 and the modelled yaw rate {dot over ()} obtained from equation 11.
(90) After switching to the model feedback phase the flying wing 2 may alternatively be controlled using a modelled horizontal angle .sub.m, a modelled vertical angle .sub.m, a modelled heading .sub.m and a modelled yaw rate {dot over ()}.sub.m. In this embodiment the horizontal position, both measured and modelled, is indicated as an angle instead of a Cartesian position. Similarly, the vertical position, both measured and modelled is indicated as an angle.
(91) The modelled heading .sub.m is continuously calculated by integrating the modelled yaw rate {dot over ()}.sub.m.
.sub.m=({dot over ()}.sub.m+{dot over ()}.sub.m,adaptation)dt+.sub.m,adaptation(10)
where
{dot over ()}.sub.m={umlaut over ()}.sub.mdt(11)
where
(92)
where is a time constant, is the turn gain, i.e. a gain related to the curvature of the spherical surface and is the angle of the rudder of the flying wing 2. The product yields a measure with the unit degrees/second.
.sub.m is iteratively adapted based on the difference between the measured vertical average angle and the modelled vertical average angle (
.sub.m,adaptation(n.sub.8)=.sub.m,adaptation(n.sub.B1)+k.sub.8(
.sub.m,adaptation(0)=0
where k.sub.8 is a tuning variable which is set to a value that allows for a suitable convergence of the adaptation towards a desired adaptation value and n.sub.8 is the iteration number. The term (
(93)
(94) The modelled yaw rate is iteratively adapted based on the difference between the measured vertical angle and the modelled vertical angle (
(95)
(96) This is thus the same adaptation used which was prepared during the sensor feedback phase. The iteration step n.sub.3 may be reset upon switching to the model feedback phase.
(97) The modelled horizontal angle .sub.m is calculated by taking an infinitesimal step dl in a horizontal direction along the predetermined trajectory over an infinitesimal time step dt.
dl= cos dt
d.sub.m can be calculated from
(98)
(99) As dl is small compared to R, d.sub.m can be approximated as
(100)
from which follows that
(101)
(102) Similarly it follows that the vertical angle is calculated by taking an infinitesimal vertical step dh along the predetermined trajectory over an infinitesimal time step dt.
dh= sin dt
d.sub.m can be calculated from
(103)
(104) As dh is small compared to R, d.sub.m can be approximated as
(105)
from which follows that
(106)
(107) The modelled vertical angle .sub.m which was prepared for switching to the model feedback phase is now used.
(108) To compensate for that the flying wing 2 may drift away from a central position along the principal direction of the fluid stream 10 the modelled horizontal angle .sub.m of the flying wing 2 is iteratively adapted by adding a term .sub.m,adaptation to equation 12.
.sub.m={dot over ()}.sub.mdt+.sub.m,adaptation(14)
where
.sub.m,adaptation(n.sub.4)=.sub.m,adaptation(n.sub.41)+k.sub.4(
.sub.m,adaptation(0)=0
where
(109) To further adapt the horizontal angle a horizontal angular speed adaptation {dot over ()}.sub.m,adaptation is added to equation 14 such that the difference
.sub.m=({dot over ()}.sub.m+{dot over ()}.sub.m,adaptation)dt+.sub.m,adaptation(15)
where
(110)
where k.sub.5 is a tuning variable which is set to a value that allows for a suitable convergence of the adaptation towards a desired adaptation value and t is the time to complete the predetermined distance along the predetermined trajectory. n.sub.5 is the iteration step. This is the same adaptation as in the sensor feedback phase. The iteration step n.sub.5 may be reset upon switching to the model feedback phase.
(111) To compensate for errors in the modelled vertical angle .sub.m, the modelled vertical angle .sub.m is iteratively adapted based on the difference between the modelled vertical angle .sub.m and the measured vertical angle by adding a term .sub.m,adaptation to equation 13.
.sub.m={dot over ()}.sub.mdt+.sub.m,adaptation(16)
where
.sub.m,adaptation(n.sub.6)=.sub.m,adaptation(n.sub.61)+k.sub.6(
.sub.m,adaptation(0)=0
where
(112) To further adapt the vertical angle a vertical angular speed adaptation {dot over ()}.sub.m,adaptation is added to equation 16 such that the difference
.sub.m=({dot over ()}.sub.m+{dot over ()}m,.adaptation)dt+.sub.m,adaptation(17)
where
(113)
(114) where k.sub.7 is a tuning variable which is set to a value that allows for a suitable convergence of the adaptation towards a desired adaptation value and t is the time to complete the predetermined distance along the predetermined trajectory. n.sub.7 is the iteration step. This is the same adaptation as in the sensor feedback phase. The iteration step n.sub.7 may be reset upon switching to the model feedback phase.
(115) The control of the flying wing 2 in the model feedback phase thus uses the modelled horizontal angle .sub.m obtained from equation 15, the modelled vertical angle .sub.m obtained from equation 17, the modelled heading obtained from equation 10 and the modelled yaw rate {dot over ()} obtained from equation 11.
(116) The values of the tuning variables k.sub.1, k.sub.2, k.sub.3, k.sub.4, k.sub.5, k.sub.6, k.sub.7, k.sub.8 and k.sub.1, k.sub.2, k.sub.3, k.sub.4, k.sub.5, k.sub.6, k.sub.7 are obtained by testing to provide the system 1 with suitable convergences. n.sub.1, n.sub.2, n.sub.3, n.sub.4, n.sub.5, n.sub.6, n.sub.7, n.sub.8 and n.sub.1, n.sub.2, n.sub.3, n.sub.4, n.sub.5, n.sub.6, n.sub.7 are iteration parameters which may or may not be equal for all the adaptations. In cases where the iteration parameters are the same for the sensor feedback phase and the model feedback phase the iteration parameters may be reset when switching between the sensor feedback phase and the model feedback phase.
(117) Reference signs mentioned in the claims should not be seen as limiting the extent of the matter protected by the claims, and their sole function is to make claims easier to understand.
(118) As will be realised, the invention is capable of modification in various obvious respects, all without departing from the scope of the appended claims. Accordingly, the drawings and the description are to be regarded as illustrative in nature, and not restrictive. For instance although the figures all describe a flying wing attached with a tether the flying wing can operate without being attached to a structure by a tether. Further, the calculations of and can easily be adapted for a flying wing according to the invention which is placed either submerged under water or above water. Above water the structure can be placed on the surface of a body of water or on land.
(119) The installation depth D can be measured to other locations than is indicated in the figures. Likewise, the position of the coordinate systems can be adapted if necessary to other locations.