Difference between revisions of "Flight Plans"

From PaparazziUAV
Jump to navigation Jump to search
(Update sectors)
 
(93 intermediate revisions by 16 users not shown)
Line 1: Line 1:
A '''flight plan''' is a XML document which one can create and store aboard an autopilot. The flight plan will describe how you want your aircraft to travel if released into into the wild blue yonder.
== DTD and Structure ==
The formal description of the flight plan file is given in the [http://en.wikipedia.org/wiki/Document_Type_Definition '''DTD'''] (located in <tt>conf/flight_plans/flight_plan.dtd</tt>). This
The formal description of the flight plan file is given in the [http://en.wikipedia.org/wiki/Document_Type_Definition '''DTD'''] (located in <tt>conf/flight_plans/flight_plan.dtd</tt>). This
DTD must be referenced in the header of your flight plan XML document using the following line:<br>
DTD must be referenced in the header of your flight plan XML document using the following line:<br>


<tt><!DOCTYPE flight_plan SYSTEM "flight_plan.dtd"></tt>
<source lang="xml"><!DOCTYPE flight_plan SYSTEM "flight_plan.dtd"></source>
 
The flight plans are stored in the <tt>conf/flight_plans</tt> directory. The [[Flight_Plan_Editor|flight plan editor]] can be used to create basic flight plans in the GUI.


== Structure of the flight plan file ==
The flight plans are stored in the <tt>conf/flight_plans</tt> directory. The [[Flight_Plan_Editor|flight plan editor]] can be used to create basic flight plans via the GUI.


Extract from the [http://en.wikipedia.org/wiki/Document_Type_Definition DTD]:
Extract from the [http://en.wikipedia.org/wiki/Document_Type_Definition DTD]:
  <tt><!ELEMENT flight_plan (header?,waypoints,sectors?,include*,exceptions?,blocks)></tt>
  <tt><!ELEMENT flight_plan (header?,waypoints,sectors?,variables?,includes?,exceptions?,blocks)></tt>


A flight plan is composed of two compulsory elements: [[#waypoints|waypoints]] and [[#blocks|blocks]] and typically contains optional <tt>include</tt>'s and global <tt>exceptions</tt>.
'''A flight plan is composed of two mandatory elements: [[#waypoints|waypoints]] and [[#blocks|blocks]]'''


The root <tt>flight_plan</tt> element is specified with several attributes:
The root <tt>flight_plan</tt> element is specified with several attributes:
  <tt><flight_plan name lat0 lon0 ground_alt security_height qfu alt max_dist_from_home></tt>
  <tt>'''<flight_plan name lat0 lon0 ground_alt security_height home_mode_height qfu alt max_dist_from_home>'''</tt>
* <tt>name</tt>: the name of the mission (a text string)
; <tt>'''name'''</tt>: The name of the mission (a text string)
* <tt>lat0, lon0</tt>: describe the latitude and longitude of the point {0,0} in WGS84 degree coordinates
; <tt>'''lat0, lon0'''</tt>: Defines the latitude and longitude coordinates of the reference point {0,0} in WGS84 degree coordinates
* <tt>ground_alt</tt>: the ground altitude (in meters). It defines the <tt>GROUND_ALT</tt> constant value which can be used to define waypoint altitudes
; <tt>'''ground_alt'''</tt>: The ground altitude (in meters), Above Sea Level where you are flying. It defines the <tt>GROUND_ALT</tt> constant value which can be used in combination with a waypoint <height> parameter to define a waypoint height
* <tt>security_height</tt>:  the altitude used by the circle-home failsafe procedure
; <tt>'''security_height'''</tt>:  The height (over <tt>'''ground_alt'''</tt>) used by the circle-home failsafe procedure and in other flight procedures such as formation flight and anti-collision avoidance. Warnings are produced if you place a waypoint lower than <tt>'''security_height'''</tt> (usually the case for the landing point)
* <tt>qfu</tt> (optional): defines the global constant <tt>QFU</tt>. It usually is the magnetic heading in degrees (north=0, east=90) of the runway, the opposite of wind direction. This constant may be used in the mission description. It is also used by the simulator as the original course of the aircraft. So if you want to take off and climb to the West you would use qfu=270.  
; <tt>'''home_mode_height'''</tt> (optional): This optional attribute available since v4.2 allows to override <tt>'''security_height'''</tt> as failsafe height in home mode. If <tt>'''home_mode_height'''</tt> Is set lower than <tt>'''security_height'''</tt>, the later is used. This attribute is useful if you need to return home at a high altitude rather than a low altitude.
* <tt>alt</tt>: the default altitude of waypoints (Above Sea Level). So if your ground altitude is 400 then alt needs to be a value greater than ground altitude and above any obstructions in the flight plan.  
; <tt>'''qfu'''</tt> (optional): defines the global constant <tt>QFU</tt>. It usually is the magnetic heading in degrees (north=0, east=90) of the runway, the opposite of wind direction. This constant may be used in the mission description. It is also used by the simulator as the original course of the aircraft. So if you want to take off and climb to the West you would use qfu=270.  
* <tt>max_dist_from_home</tt>: the maximum allowed distance (in meters) from the HOME waypoint. Exceeding this value will trigger an exception.
; <tt>'''alt'''</tt>: The default altitude of waypoints ([[Altitude_definitions|Above Sea Level]]). So if your ground altitude is 400 then alt needs to be a value greater than ground altitude and above any obstructions in the flight plan.  
; <tt>'''max_dist_from_home'''</tt>: A radius representing the maximum allowed distance (in meters) from the HOME waypoint. Exceeding this value (ie flying outside the circle with this radius) will trigger an exception. It is up to you to define the block to be executed (ie what to do) for the exception.
 


Here is an example of the first line of a flight plan:
''Here is an '''example''' of such a line in the top of a flight plan:''


<tt>
<source lang="xml">
   <flight_plan name="Example Muret"
   <flight_plan alt="250" ground_alt="185" lat0="43.46223" lon0="1.27289" name="Example Muret" max_dist_from_home="300" qfu="270" security_height="25" >
  lat0="43.46223" lon0="1.27289" max_dist_from_home="300" qfu="270"
</source>
  ground_alt="185" security_height="25" alt="250">
</tt>


=== Waypoints ===
Note that a flight plan could also contain optional <tt>include</tt>'s and <tt>exceptions</tt> cases.


The waypoints are the geographic locations used to specify the trajectories. A waypoint is specified with its name and its relative coordinates:
In English the above flight plan says the name is Example Muret. The reference coordinates for the 0,0 point is: 43.46223 (lat) and 1.27289 (long). The flying site 0,0 location is 185m above sea level. The security height is 25m above 0,0 point or 210m above sea level. The default (ie if not defined in a waypoint this alt is used) altitude is 250m (above sea level). The home mode block altitude is defined to be 150m above sea level. Also, for security, a circle is defined with a radius that's 300m from 0,0 position. This is the max_dist_from_home value. Fly 301m from 0,0 and an exception is triggered. A useful block is to trigger/go to the home mode block and return to home when the aircraft flies outside the safety circle. Example flight plans are helpful for study before you build your own from scratch.
<tt> <waypoint name x y [alt] [height]/> </tt>
where '''x''' and '''y''' are real positional coordinates, '''or''' relative coordinates in meters from your reference point {0,0} . <tt>alt</tt> and <tt>height</tt>are optional and can be used to assign an altitude to a particular waypoint that is different from the globally defined <tt>alt</tt> above. To set the waypoint altitude relative to the ground altitude (<tt>ground_alt</tt>)on this coordinate, you can use the <tt>height</tt> attribute instead of <tt>alt</tt> Height is the simplified form of setting <tt>ground_alt+xx</tt> in the <tt>alt</tt> attribute).


Note that a waypoint named <tt>HOME</tt> is required as it is used by the failsafe HOME mode procedure.
== Waypoints ==
 
The waypoints are the geographic locations used to specify the trajectories. A waypoint is specified by it's name and coordinates:
<tt>''' <waypoint name wpx wpy [alt] [height]/> '''</tt>
where wpx and wpy are real positional coordinates ( <tt>'''lat/lon'''</tt> )  '''or''' UTM coordinates ( <tt>'''utm_x0/utm_y0'''</tt> ) '''or''' relative coordinates ( <tt>'''x/y'''</tt> ) in meters from your reference point {0,0} .  <tt>alt</tt> is an optional parameter and can be used to assign an altitude to a particular waypoint that is different from the globally defined <tt>alt</tt> parameter of the flightplan. The <tt>height</tt> attribute can be used to set the waypoint height relative to the [[Altitude_definitions|ground altitude]] (<tt>ground_alt</tt>) of the flight plan for this waypoint.


An example:
An example:
<tt>
<source lang="xml">
<waypoints>
  <waypoints>
  <waypoint name="HOME" x="0.0" y="30.0"/>
    <waypoint name="HOME" x="0.0" y="30.0"/>
  <waypoint name="BRIDGEOVERRIVER" x="-100.0" y="60.0" alt="270."/>
    <waypoint name="BRIDGEOVERRIVER" x="-100.0" y="60.0" alt="270."/>
  <waypoint name="MyBarn" x="-130.0" y="217.5" alt="3000."/>
    <waypoint name="MyBarn" x="-130.0" y="217.5" alt="3000."/>
  <waypoint name="3" x="-30.0" y="50" alt="ground_alt + 50."/>
    <waypoint name="3" x="-30.0" y="50" height="50."/>
  <waypoint name="4" x="-30.0" y="60" height="50."/>
    <waypoint name="4" x="-30.0" y="50." alt="ground_alt + 50"/>
  <waypoint name="_MYHELPERSPOT" x="-30.0" y="60" height="50."/>
    <waypoint name="_MYHELPERSPOT" x="-30.0" y="60" height="50."/>
</waypoints>
    <waypoint name="_MYOTHERHELPERSPOT" x="-70.0" y="90" height="70."/>
</tt>
    <waypoint name="TOWER" lat="48.858249" lon="2.294494" height="324."/>
    <waypoint name="MountainCAFE" utm_x0="360284.8" utm_y0="4813595.5" alt="1965."/>
  </waypoints>
</source>


'''Tips'''
'''Tips'''
* Waypoints are easily adjusted with the [[Flight_Plan_Editor|flight plan editor]].
* Waypoints are easily adjusted with the [[Flight_Plan_Editor|flight plan editor]].
* If a waypoint name starts with an underscore, the waypoint is not displayed in the GCS, except in editor mode.
* If a waypoint name starts with an underscore ( _ ), the waypoint is '''not displayed''' in the GCS, except in editor mode.
* The maximum number of waypoints is 254.
* The maximum number of waypoints is 254.
* A waypoint named <tt>HOME</tt> is required if the failsafe HOME mode procedure is used.
* A waypoints index/reference pointer is derived by prefixing the waypoint name with "WP_". Useful when a [[#Call |call function]] uses the waypoints reference index vs. it's name.
== Sectors ==
Flat ''Sectors'' can be described as an area defined by a list of waypoint corners. Such an area will be displayed in the Ground Control Station (GCS) by colored lines connecting the cornerpoints.
A function is generated to check if a point, usually the aircraft itself, is ''inside'' this sector.
For a sector named <tt>MyBigGarden</tt> the generated function for the example here would be <tt>bool_t InsideMyBigGarden(float x, float y);</tt> where <tt>x</tt> and <tt>y</tt> are east and north coordinated, in meters, relative to the geographic reference of the flight plan.
Note that sector names are not allowed to contain spaces.
'''Note:''' The edges of the polygon should not cross each other.
For example, with the following element in a flight plan.
<source lang="xml">
  <sectors>
    <sector name="MyBigGarden" color="red">
      <corner name="_1"/>
      <corner name="_2"/>
      <corner name="_3"/>
      <corner name="_4"/>
    </sector>
  </sectors>
</source>
It is then possible to add an exception clause to your flightplan. For example if the aircraft for some reason flies outside this sector, the airframe will fly to a standby waypoint. The exclamation mark (!) means the boolean operator <tt>NOT</tt> in this example. In regular language one would describe "If my airframe is NOT inside the MyBigGarden sector anymore then deroute it to the standby waypoint. In Flightplan "Speak" this is written like:
<source lang="xml">
<exception cond="! InsideMyBigGarden(GetPosX(), GetPosY())" deroute="standby"/>
</source>
'''Tip:''' The color indicating the sector borders is not fixed but can be defined by oneself if wished for via the color attribute.
=== Before version 6.0 ===
Before version 6.0, there was "static" and "dynamic" sectors. The default type of a sector was "static", except if the extra attribute '''type="dynamic"''' was added.
Static sectors have these limitations:
* The polygon need to be <b>convex</b> and described in a <b>clockwise</b> order.
* If the flight plan is dynamically relocated, such a sector will be relocated but the display is not updated on the GCS.
* editing of the waypoints of the sector during the flight do not dynamically update the inside function. It will always check if the position is inside the original sector.
== Variables ==
'''Available since v5.9'''
It is possible to declare a list of variables that will be automatically created during the flight plan generation and available for the rest of the system from the generated flight plan header and of course inside the flight plan itself. With appropriate attributes, it is also possible to make the variables accessible from the telemetry as a [[Settings|setting]].
The following code will produce a '''float''' variable initialized to 0:
<source lang="xml">
  <variables>
    <variable var="my_var"/>
  </variables>
</source>
The type and the initial value can be changed with the '''type''' and '''init''' attributes:
<source lang="xml">
  <variables>
    <variable var="my_var" init="10" type="int"/>
  </variables>
</source>
To produce an automatic setting for a variable, at least '''min''', '''max''' and '''step''' attributes need to be specified:
<source lang="xml">
  <variables>
    <variable var="my_var" min="0." max="10." step="0.1"/>
  </variables>
</source>
They will appear under the '''Flight Plan''' settings tab in the GCS. So more attributes can be specified: '''shortname''', '''unit''', '''alt_unit''', '''alt_unit_coef''', '''values'''. See [[Settings]] page for more information about these options.


=== Sectors ===
== Modules ==
Flat ''Sectors'' can be described as a list of waypoint corners. Such an area will be displayed in the GCS (a optional color can be specified).
Additional modules can be added to the airframe using the ''modules'' element inside the flight plan. The same syntax is used as in the airframe file:
A function is generated to check if a point (usually the aircraft itself) is ''inside'' the polygon. Currently, this feature requires that the polygon is <b>convex</b> and described in a <b>clockwise</b> order. For a sector named <tt>sector</tt> (sector names must not contain spaces), the generated function is <tt>bool_t InsideSector(float x, float y);</tt> where <tt>x</tt> and <tt>y</tt> are east and north coordinated, in meters, relative to the geographic reference of the flight plan. Note: If the flight plan is dynamically relocated, such a sector will be relocated but the display is currently not updated on the GCS.


For example, with the following element in a flight plan (waypoints which name starts with an underscore are not displayed in the GCS, except in editor mode)
<source lang="xml">
<tt>
  <modules>
<sectors>
    <module name="demo_module">
  <sector name="Muret" color="red">
      <define name="MY_DEFINE" value="0"/>
  <corner name="_1"/>
      <configure name="MY_CONF" value="0"/>
  <corner name="_2"/>
      ...
  <corner name="_3"/>
    </module>
  <corner name="_4"/>
  </modules>
  </sector>
</source>
</sectors>
</tt>
It is then possible to write a exception. For example if the aircraft for some reason flies outside this sector the airframe will fly to the standby point. The exclamation mark (!) means the operator NOT in the example. In regular language one would describe "If my airframe is NOT inside the Murret sector anymore then deroute it to the standby waypoint." In Flightplan "Speak" this is written like:
<tt>
<exception cond="! InsideMuret(estimator_x, estimator_y)" deroute="standby"/>
</tt>


=== Includes ===
== Includes ==


<tt>include</tt> is used to add some flight plan elements defined in an external procedure. It’s useful to include pre-written procedures with only few arguments and then clarify the flight plan.
<tt>include</tt> is used to add some flight plan elements defined in an external procedure. It’s useful to include pre-written procedures with only few arguments and then clarify the flight plan.
Line 86: Line 154:


Here is an example:
Here is an example:
<tt><includes>
<source lang="xml">
  <include name="landing" procedure="landing.xml"/>
  <includes>
   </includes></tt>
    <include name="landing" procedure="landing.xml"/>
   </includes>
</source>


=== Blocks ===
== Blocks ==


Block elements are the main part of a flight plan: they describe each unit of the mission.
Block elements are the main part of a flight plan: they describe each unit of the mission.
They are made of various primitives, called stages and exceptions, you can put one after the other. When a
They are made of various primitives, called stages and exceptions, you can put one after the other. When a
stage (or a block) is finished, the autopilot goes to the next one. The behaviour after the last stage of the last block is undefined.
stage (or a block) is finished, the autopilot goes to the next one. The behaviour after the last stage of the last block is undefined.  


As described in the DTD, the <tt>blocks</tt> element is composed of <tt>block</tt> elements which are sequence of ''stages'':
As described in the DTD, the <tt>blocks</tt> element is composed of <tt>block</tt> elements which are sequence of ''stages'':
<tt><!ELEMENT blocks (block+)>
<source lang="xml">
<!ELEMENT block (exception|while|heading|attitude|go|xyz|set|circle|deroute|stay|follow
  <!ELEMENT blocks (block+)>
                          |survey_rectangle)*></tt>
  <!ELEMENT block (exception|while|heading|attitude|go|xyz|set|call|circle|deroute|stay|follow|survey_rectangle|for|return|eight|oval|home|path)*>
</source>


Example:
Example:
<tt><block name="circlehome">
<source lang="xml">
  <circle radius="75" wp="HOME"/>
  <block name="circlehome">
</block></tt>
    <circle radius="75" wp="HOME"/>
  </block>
</source>


You can add a button in the [[GCS#Strips|strip of the aircraft]] with the attribute <tt>strip_button</tt>:
You can add a button in the [[GCS#Strips|strip of the aircraft]] with the attribute <tt>strip_button</tt>:
<tt><block name="descent" strip_button="Descent">
<source lang="xml">
  <circle wp="HOME" throttle="0.0" pitch="-15" vmode="throttle"/>
  <block name="descent" strip_button="Descent">
</block> </tt>
    <circle wp="HOME" throttle="0.0" pitch="-15" vmode="throttle"/>
  </block>
</source>
This button will activate the block. If the attribute <tt>group</tt> is specified, all strip buttons of the same group will be placed vertically on top of each other.
This button will activate the block. If the attribute <tt>group</tt> is specified, all strip buttons of the same group will be placed vertically on top of each other.


In the same way, a key shortcut can be specified:
In the same way, a key shortcut can be specified:
<tt><block key="D" name="descent" strip_button="Descent">
<source lang="xml">
  <circle wp="HOME" throttle="0.0" pitch="-15" vmode="throttle"/>
  <block key="D" name="descent" strip_button="Descent">
</block> </tt>
    <circle wp="HOME" throttle="0.0" pitch="-15" vmode="throttle"/>
  </block>
</source>
Modifiers are allowed, using the syntax of [http://library.gnome.org/devel/gtk/2.15/gtk-Keyboard-Accelerators.html#gtk-accelerator-parse GTK accelerators].
Modifiers are allowed, using the syntax of [http://library.gnome.org/devel/gtk/2.15/gtk-Keyboard-Accelerators.html#gtk-accelerator-parse GTK accelerators].


An icon can be specified to display the button. The <tt>strip_button</tt> label then is a tooltip for the icon. The icon must be an image file available in the directory <tt>data/pictures/gcs_icons</tt>:
An icon can be specified to display the button. The <tt>strip_button</tt> label then is a tooltip for the icon. The icon must be an image file available in the directory <tt>data/pictures/gcs_icons</tt>:
<tt><block name="Takeoff" strip_icon="takeoff.png" strip_button="Takeoff"></tt>
<source lang="xml"><block name="Takeoff" strip_icon="takeoff.png" strip_button="Takeoff"></source>


You can call functions before or after each execution of the block:
You can call functions before or after each execution of the block:
<tt><block name="circlehome" pre_call="function_to_call_before_circle()" post_call="function_to_call_after_circle()">
<source lang="xml">
  <circle wp="HOME"/>
  <block name="circlehome" pre_call="function_to_call_before_circle()" post_call="function_to_call_after_circle()">
</block></tt>
    <circle wp="HOME"/>
  </block>
</source>


===== Expressions =====
==== Expressions ====


Most of the numeric attributes in stages are analyzed as C expressions. The syntax of this C expression is restricted to  
Most of the numeric attributes in stages are analyzed as C expressions. The syntax of this C expression is restricted to  
* numeric constants
* numeric constants
* some internal autopilot variables (not fully documented, see examples)
* some internal autopilot variables (not fully documented, see [[Flight_Plans#Internal_Variables_in_Flight_Plans|internal variables section]] below and other examples)
* Some binary operators: <, >, <=, >=, <>, ==, +, -, /, *
* Some binary operators: <, >, <=, >=, <>, ==, +, -, /, *
* Some utility functions
* Some utility functions
* Since some operators are not very compliant with the XML specifications (especially '<'), you can use some alternate naming:
** @LT (less than, <)
** @GT (greater than, >)
** @LEQ (less or equal, <=)
** @GEQ (greater or equal, >=)
** @AND ( && )
** @OR ( || )
** @DEREF ( -> )


Some examples of usable expressions are given in the next sections.
Some examples of usable expressions are given in the next sections.


==== Exceptions ====
=== Initialization  Blocks ===
Most flight plans will have three blocks of flight plan initialization blocks. It is good practice to follow this example below if you first start learning to create flightplans
 
The first block waits until the GPS fix has been established, as shown below.
<source lang="xml">
  <blocks>
    <block name="Wait GPS">
      <set value="1" var="kill_throttle"/>
      <while cond="!GpsFixValid()"/>
    </block>
</source>
The second block updates the local waypoints with respect to the UAV.
<source lang="xml">
    <block name="Geo init">
      <while cond="LessThan(NavBlockTime(), 10)"/>
      <call fun="NavSetGroundReferenceHere()"/>
    </block>
</source>
This next block prevents the UAV from starting the engine and taking off.
<source lang="xml">
    <block name="Holding point">
      <!--set var="nav_mode" value="NAV_MODE_ROLL"/-->
      <set value="1" var="kill_throttle"/>
      <attitude roll="0" throttle="0" vmode="throttle"/>
    </block>
</source>
 
=== Exceptions ===


The flight manager can handle exceptions. They consist in conditions checked periodically (at the same pace as the navigation control), allowing the control to jump to a given block. Here is the syntax of exceptions:
The flight manager can handle exceptions. They consist in conditions checked periodically (at the same pace as the navigation control), allowing the control to jump to a given block. Here is the syntax of exceptions:
<tt><exception cond="..." deroute="..."></tt>
<source lang="xml"><exception cond="..." deroute="..."></source>
where <tt>cond</tt> is an expression and <tt>deroute</tt> is the name of the block we want to switch to as soon as the condition is true.
where <tt>cond</tt> is an expression and <tt>deroute</tt> is the name of the block we want to switch to as soon as the condition is true.


Here are some example of exceptions:
Here are some example of exceptions:
<tt><exception cond="10 > PowerVoltage()" deroute="go_down"/>
<source lang="xml">
<exception cond="(ground_alt+10 > estimator_z)" deroute="go_up"/>
  <exception cond="10 > PowerVoltage()" deroute="go_down"/>
<exception cond="(estimator_flight_time > 840)" deroute="quick_land"/></tt>
  <exception cond="(ground_alt+10 > GetPosAlt())" deroute="go_up"/>
  <exception cond="(autopilot_flight_time > 840)" deroute="quick_land"/>
</source>


Exceptions can be local to a block or global to the flight plan, in the <tt><exceptions></tt> element. In the following example, time since last reception of a message from the ground station is monitored and the navigation is switched to the <tt>Standby</tt> block if no message have been received for 22s. This exception is valid for '''all''' the blocks.
Exceptions can be local to a block or global to the flight plan, in the <tt><exceptions></tt> element. In the following example, time since last reception of a message from the ground station is monitored and the navigation is switched to the <tt>Standby</tt> block if no message have been received for 22s. This exception is valid for '''all''' the blocks.
<tt><flight_plan ...>
<source lang="xml">
  <waypoints> ... </waypoints>
  <flight_plan ...>
  <exceptions>
    <waypoints> ... </waypoints>
    <exception cond="datalink_time > 22" deroute="Standby"/>
    <exceptions>
  </exceptions>
      <exception cond="datalink_time > 22" deroute="Standby"/>
   <blocks> ...</tt>
    </exceptions>
   <blocks> ...
</source>


==== Deroute ====
=== Deroute ===


The <tt>deroute</tt> is the ''goto'' directive of the flight plan; it switches the navigation to the given block:
The <tt>deroute</tt> is the ''goto'' directive of the flight plan; it switches the navigation to the given block:
<tt>
<source lang="xml"><deroute block="landing"/></source>
<deroute block="landing"/></tt>


Note that this primitive should not be used to execute loops which are provided by the following elements.
Note that this primitive should not be used to execute loops which are provided by the following elements.


==== Loops ====
=== Return ===
 
The <tt>return</tt> is also a ''goto'' directive that brings you back to the last block (and last stage). It has no argument.
<source lang="xml"><return/></source>
 
=== Loops ===


Unbounded loops are written with <tt>while</tt> elements whose <tt>cond</tt> attribute is a boolean expression.
Unbounded loops are written with <tt>while</tt> elements whose <tt>cond</tt> attribute is a boolean expression.
Children  of <tt>while</tt> are stages:
Children  of <tt>while</tt> are stages:
<tt><while cond="TRUE">
<source lang="xml">
  <go wp="A"/>
  <while cond="TRUE">
  <go wp="B"/>  
    <go wp="A"/>
  <go wp="C"/>
    <go wp="B"/>  
  <while cond="5 > stage_time"/>
    <go wp="C"/>
</while></tt>
    <while cond="5 > stage_time"/>
In this example, we run an infinite loop, going to waypoints <tt>A</tt>, <tt>B</tt> and <tt>C</tt> and waiting for 5 seconds before repeating.
  </while>
 
</source>
In this example, we run an infinite loop, letting the aircraft try to go via waypoints <tt>A</tt>, <tt>B</tt> and <tt>C</tt> and waiting for 5 seconds before repeating.


Bounded loops are written with the <tt>for</tt> tag:
Bounded loops are written with the <tt>for</tt> tag:
<tt><for var="i" from="0" to="3">
<source lang="xml">
...
  <for var="i" from="0" to="3">
</for></tt>
    ...
  </for>
</source>
where the body of the loop will be run four times.
where the body of the loop will be run four times.


The variable of a <tt>for</tt> loop can be used inside expressions appearing as attributes of the stages:
The variable of a <tt>for</tt> loop can be used inside expressions appearing as attributes of the stages:
<tt><for var="i" from="1" to="5">
<source lang="xml">
  <circle wp="HOME" radius="75" alt="ground_alt+50*$i" until="stage_time>10" />
  <for var="i" from="1" to="5">
</for></tt>
    <circle wp="HOME" radius="75" alt="ground_alt+50*$i" until="stage_time>10" />
In this example, we circle around '''HOME''' 10 seconds at height 50m, 10s at height 100m, ... until height 250m.
  </for>
Note: Two bounded loops using the same control variable are not allowed in the same block.
</source>


==== Navigation modes ====
In this example, the aircraft will circle around waypoint '''HOME''' for 10 seconds at an altitude above ground of 50m (1x50), 10 seconds at an altitude of 100m (2x50), ... until 250m (5x50).
 
Note: Two bounded loops using the same control variable are not allowed in the same block. Further, I tested a specific implementation installation of PaparazziUAV v5.10 and I found the maximum range of the looping variable to be -128 to 126.
 
=== Navigation modes ===


Navigation modes give the description of the desired trajectory in 3D. While the horizontal mode is specified through
Navigation modes give the description of the desired trajectory in 3D. While the horizontal mode is specified through
Line 196: Line 325:
* heading : keep a given course;
* heading : keep a given course;
* go : go to a given waypoint;
* go : go to a given waypoint;
* path : list of waypoints linked by ''go''
* circle : circle around a waypoint;
* circle : circle around a waypoint;
* oval : two half circles with a straight between two nav points
* eight : fly a figure of eight through a waypoint and around another
* stay : hold the position (hard to realize for a fixed-wing aircraft);
* stay : hold the position (hard to realize for a fixed-wing aircraft);
* follow : follow another aircraft;
* follow : follow another aircraft;
* xyz : circle around a point moveable with the RC transmitter stick (obsolete with the datalink).
* xyz : circle around a point where XY moveable with the RC transmitter stick, Z with other stick or slider


The vertical control is achieved using the <tt>vmode</tt> attribute of these stages. The possible values are  
The vertical control is achieved using the <tt>vmode</tt> attribute of these stages. The possible values are  
Line 212: Line 344:
The different navigation modes are detailed in the next sections.
The different navigation modes are detailed in the next sections.


==== Attitude ====
=== Attitude ===
 
Element <tt>attitude</tt> is the navigation mode which corresponds to the current lowest control loop for horizontal mode.
Element <tt>attitude</tt> is the navigation mode which corresponds to the current lowest control loop for horizontal mode.
The autopilot then keeps a constant attitude. The <tt>roll</tt> attribute is required (in degrees, positive to put right wing low).
The autopilot then keeps a constant attitude. The <tt>roll</tt> attribute is required (in degrees, positive to put right wing low).


To fly away, at constant airspeed:
To fly away, at constant airspeed:
<tt><attitude roll="0" vmode="throttle", throttle="0.5"/></tt>
<source lang="xml"><attitude roll="0" vmode="throttle", throttle="0.5"/></source>


To fly around, holding a given altitude:
To fly around, holding a given altitude:
<tt><attitude roll="30" alt="ground_alt+50"/></tt>
<source lang="xml"><attitude roll="30" alt="ground_alt+50"/></source>


Note that it is not a ''safe'' navigation mode since the geographic position of the plane is not controlled. However, this mode is useful to tune the roll attitude control loop.
Note that it is not a ''safe'' navigation mode since the geographic position of the plane is not controlled. However, this mode is useful to tune the roll attitude control loop.


==== Heading ====
=== Heading ===
 
<tt>heading</tt> primitive is relative to the second level loop for horizontal mode in the autopilot which will keep the given <tt>course</tt>, a required attribute (in degrees, clockwise, north=0, east=90).
<tt>heading</tt> primitive is relative to the second level loop for horizontal mode in the autopilot which will keep the given <tt>course</tt>, a required attribute (in degrees, clockwise, north=0, east=90).


One example to takeoff, following the QFU, 80% throttle, nose up (15 degrees) until height of 30m is reached:
One example to takeoff, following the QFU, 80% throttle, nose up (15 degrees) until height of 30m is reached:
<tt><heading course="QFU" vmode="throttle" throttle="0.8" pitch="15" until="(estimator_z > ground_alt+30)"/></tt>
<source lang="xml"><heading course="QFU" vmode="throttle" throttle="0.8" pitch="15" until="(GetPosAlt() > ground_alt+30)"/></source>
 
=== Go ===


==== Go ====
The <tt>go</tt> primitive is probably the most useful one. Basically, the autopilot will try to join a given waypoint (<tt>wp</tt>, the only required attribute). So the simplest thing you can ask for is
The <tt>go</tt> primitive is probably the most useful one. Basically, the autopilot will try to join a given waypoint (<tt>wp</tt>, the only required attribute). So the simplest thing you can ask for is
<tt><go wp="HOME"/></tt>
<source lang="xml"><go wp="HOME"/></source>
which will set the '''HOME''' waypoint as the desired target position. Note than since <tt>vmode="alt"</tt> is the default, the altitude of the target waypoint is also taken into account. The navigation will switch to the next stage as soon as the target is reached.
which will set the '''HOME''' waypoint as the desired target position. Note than since <tt>vmode="alt"</tt> is the default, the altitude of the target waypoint is also taken into account. The navigation will switch to the next stage as soon as the target is reached.


It is usually not a good idea to try to join a waypoint without asking for a precise trajectory, i.e. a given line.
It is usually not a good idea to try to join a waypoint without asking for a precise trajectory, i.e. a given line.
Setting the <tt>hmode</tt> attribute to '''route''', the navigation will go over a segment joining two waypoints:
Setting the <tt>hmode</tt> attribute to '''route''', the navigation will go over a segment joining two waypoints:
<tt><go from="wp1" wp="wp2" hmode="route"/></tt>
<source lang="xml"><go from="wp1" wp="wp2" hmode="route"/></source>


The target altitude is the altitude of the target waypoint; it can also be set with the <tt>alt</tt> attribute. The following example keeps an altitude with fixed throttle:
The target altitude is the altitude of the target waypoint; it can also be set with the <tt>alt</tt> attribute. The following example keeps an altitude with fixed throttle:
<tt><go from="wp2" wp="wp3" hmode="route" pitch="auto" throttle="0.75" alt="ground_alt+100"/></tt>
<source lang="xml"><go from="wp2" wp="wp3" hmode="route" pitch="auto" throttle="0.75" alt="ground_alt+100"/></source>


The attributes related to the vertical control can also be set to replace the default altitude mode:
The attributes related to the vertical control can also be set to replace the default altitude mode:
<tt><go from="wp1" wp="wp2" hmode="route" vmode="climb" climb="1.5"/></tt>
<source lang="xml"><go from="wp1" wp="wp2" hmode="route" vmode="climb" climb="1.5"/></source>


Finally, the <tt>approaching_time</tt> (in seconds) attribute helps to decide when the target is ''reached''. It can be set
Finally, the <tt>approaching_time</tt> (in seconds) attribute helps to decide when the target is ''reached''. It can be set
to '''0''' to go over the target waypoint (default value is the '''CARROT''' time, set in the airframe configuration file).
to '''0''' to go over the target waypoint (default value is the '''CARROT''' time, set in the airframe configuration file).
<tt><go from="wp1" wp="wp2" hmode="route" approaching_time="1"/></tt>
<source lang="xml"><go from="wp1" wp="wp2" hmode="route" approaching_time="1"/></source>
 
=== Path ===


==== Circle ====
The <tt>path</tt> primitive is just a shorthand expression for a set of <tt>go</tt> primitives. A list of waypoints defined with the <tt>wpts</tt> attribute is pre-processed into a set of <tt>go</tt> primitives with the <tt>hmode</tt> attribute. For example:
<source lang="xml"><path wpts="wp1, wp2, wp3"/></source>
 
Other attributes are optional:
<source lang="xml"><path wpts="wp3, wp1, wp2" approaching_time="1" pitch="auto" throttle="0.5"/></source>
 
=== Circle ===


The <tt>circle</tt> primitive is the second main navigation mode: the trajectory is defined as a circle around a given waypoint with a given radius:
The <tt>circle</tt> primitive is the second main navigation mode: the trajectory is defined as a circle around a given waypoint with a given radius:
<tt><circle wp="HOME" radius="75"/></tt>
<source lang="xml"><circle wp="HOME" radius="75"/></source>
A positive radius makes the UAS move clockwise, a negative counter-clockwise.
A positive radius makes the UAS move clockwise, a negative counter-clockwise.


The <tt>until</tt> attribute may be used to control the end of the stage. The following example defines an ascending trajectory at constant throttle, nose up (15 degrees), over growing circles, until the battery level is low:
The <tt>until</tt> attribute may be used to control the end of the stage. The following example defines an ascending trajectory at constant throttle, nose up (15 degrees), over growing circles, until the battery level is low:
<tt><circle wp="wp1" radius="50+(estimator_z-ground_alt)/2" vmode="throttle" throttle="0.75" pitch="15" until="10>PowerVoltage()"/></tt>
<source lang="xml"><circle wp="wp1" radius="50+(GetPosAlt()-ground_alt)/2" vmode="throttle" throttle="0.75" pitch="15" until="10>PowerVoltage()"/></source>


==== Follow ====
=== Oval ===
The oval consists of two half circles that are connected with two straight lines. This flight path is usefull when a IMU is used because the straights allow for level flight.
<source lang="xml"> <oval p1="1" p2="2" radius="nav_radius"/> </source>
 
=== Eight ===
'''Works only for Fixed-wing!''' Fly a figure of eight that consists of two straight legs that pass though the center and the center of the half circle at the end of the two legs is in the turn around  waypoint. The altitude of the center waypoint is used for the entire figure. The turn around waypoint is moved to match radius given.
<source lang="xml">  <eight center="1" radius="nav_radius" turn_around="2"/> </source>
 
=== Survey rectangle ===
Fly a survey rectangle defined by two waypoints. The distance between the legs of the grid (in meter) and the orientation of the grid (NS or WE) can be set by the operator. The plane will turn outside of the border of the rectangle before starting a new leg.
<source lang="xml">  <survey_rectangle wp1="1" wp2="2" grid="200" orientation="NS"/> </source>
 
=== Follow ===


The <tt>follow</tt> is a special primitive which makes the UAS follow another UAS (real or simulated, named with its <tt>ac_id</tt>) at a given <tt>distance</tt> (in meters) behind and at a given <tt>height</tt> (in meters) above.
The <tt>follow</tt> is a special primitive which makes the UAS follow another UAS (real or simulated, named with its <tt>ac_id</tt>) at a given <tt>distance</tt> (in meters) behind and at a given <tt>height</tt> (in meters) above.


In this example, the autopilot will try to follow A/C number '''4''', staying '''50'''m behind and '''20'''m above.
In this example, the autopilot will try to follow A/C number '''4''', staying '''50'''m behind and '''20'''m above.
<tt><follow ac_id="4" distance="50" height="20"/></tt>
<source lang="xml"><follow ac_id="4" distance="50" height="20"/></source>
Note that the <tt>traffic_info.c</tt> file is required by this feature and the <tt>TRAFFIC_INFO</tt> flag has to be set to enable it. Then, the following lines must be added in the airframe file:
<tt>ap.srcs += traffic_info.c</tt>
<tt>ap.CFLAGS += -DTRAFFIC_INFO</tt>
<tt>sim.srcs += traffic_info.c</tt>
<tt>sim.CFLAGS += -DTRAFFIC_INFO</tt>


==== Stay ====
=== Stay ===


The <tt>stay</tt> is a mode for UAS's able to hover:
The <tt>stay</tt> Here the UAS with try to stay at the waypoint as best as it can. For an aircraft capable of hovering it will just hang above the waypoint. If the UAV has no hover capabilities,<tt>stay</tt> will mean the aircraft will constantly fly straight through the waypoint in a flower like pattern with the smallest turn radius it can manage.
<tt><stay wp="HOME" alt="10"/></tt>
<source lang="xml"><stay wp="HOME" alt="10"/></source>


==== Xyz ====
=== Abide ===
 
The <tt>abide</tt> Here the UAS with try to abide at the waypoint as best as it can. For an aircraft capable only capable of hovering it will just hang above the waypoint. For a fixedwing or a Hybrid type UAV,<tt>stay</tt> will mean the aircraft will constantly fly straight through the waypoint in a flower like pattern with the smallest turn radius it can manage.
<source lang="xml"><abide wp="SAMPLEME" alt="95"/></source>
 
''Note that you current Paparazzi version might not have this option yet.'', use stay as an alternative
 
=== XYZ ===


<tt>xyz</tt> is a special mode where the UAS circles around a user moveable waypoint. This waypoint is moved with the RC sticks:
<tt>xyz</tt> is a special mode where the UAS circles around a user moveable waypoint. This waypoint is moved with the RC sticks:
Line 283: Line 440:


Example (default radius is '''100'''):
Example (default radius is '''100'''):
<tt><xyz radius="40"/></tt>
<source lang="xml"><xyz radius="40"/></source>
 
=== Set ===


==== Set ====
The <tt>set</tt> element is a dangerous one which should be used only by expert users: it is used to directly set an internal variable of the autopilot. For example, you can change the value of the default ground altitude, a variable used by the home mode failsafe procedure (and maybe by your own flight plan):
The <tt>set</tt> element is a dangerous one which should be used only by expert users: it is used to directly set an internal variable of the autopilot. For example, you can change the value of the default ground altitude, a variable used by the home mode failsafe procedure (and maybe by your own flight plan):
<tt><set var="ground_alt" value="ground_alt+50"/></tt>
<source lang="xml"><set var="ground_alt" value="ground_alt+50"/></source>
This directive is extremely powerful and has great potential for error - use with caution.
This directive is extremely powerful and has great potential for error - use with caution.


==== Call ====
=== Call ===
 
The <tt>call</tt> allows the user to define its own navigation procedures in C. The <tt>value</tt> must be a call to a boolean function which must return TRUE as long as the stage is not completed (a function which should be called only once would then return immediately FALSE).
The <tt>call</tt> allows the user to define its own navigation procedures in C. The <tt>value</tt> must be a call to a boolean function which must return TRUE as long as the stage is not completed (a function which should be called only once would then return immediately FALSE).
This feature is illustrated with the '''line''' pattern:
This feature is illustrated with the '''line''' pattern:
<tt><call fun="nav_line_init()"/>
<source lang="xml">
<call fun="nav_line(WP_1, WP_2, nav_radius)"/></tt>
  <call fun="nav_line_setup()"/>
where <tt>nav_line_init()</tt> returns FALSE and <tt>nav_line()</tt> always returns TRUE (this stage never ends).
  <call fun="nav_line_run(WP_1, WP_2, nav_radius)"/>
Such functions usually are defined in a supplementary C file which must be specified in the airframe file (in the <tt>makefile</tt> section)
</source>
<tt>ap.srcs += nav_line.c
where <tt>nav_line_setup()</tt> returns FALSE and <tt>nav_line_run()</tt> always returns TRUE (this stage never ends). '''Note''' that a waypoints index is derived/denoted by prefixing the waypoint name with <tt>WP_</tt>(i.e.: 1 --> WP_1, 2 --> WP_2)
sim.srcs += nav_line.c</tt>
<br />
These functions also must be declared in a header file which must be mentioned in the header element of the flight plan:
 
<tt><header>
To call ''any'' function exactly once regardless of the return value (e.g. call a void function), add <tt>loop="FALSE"</tt>
#include "nav_line.h"
<source lang="xml">
</header></tt>
  <call fun="viewvideo_take_shot(TRUE)" loop="FALSE"/>
These C source file and H header file must be located in the <tt>sw/airborne</tt> directory.
</source>
or use the <tt>call_once</tt> alias:
<source lang="xml">
  <call_once fun="viewvideo_take_shot(TRUE)"/>
</source>


You can also call functions before or after each execution of the block:
Such extra navigation functions are usually written as a [[Modules|Module]] and the header files are included automatically.
<tt><block name="circlehome" pre_call="function_to_call_before_circle()" post_call="function_to_call_after_circle()">
  <circle wp="HOME"/>
</block></tt>


== Advanced Examples ==
If you want to call functions that are not part of a module, you need to include the header file which contains the function declaration:or supplementary C file which must be specified in the
Parameters used in a flight plan can be computed expressions. In this example, the plane is asked to perform 5 circles at progressively increasing altitudes for exactly one minute at each altitude:
<source lang="xml">
<for var = "i" from = "1" to = "5">
   <header>
   <circle wp = "HOME" radius="75"
#include "path/to/header.h"
          alt = "ground_alt+50*$i"
  </header>
          until = "stage_time>60" />
</source>
</for>
where the path is relative to the <tt>sw/airborne</tt> directory.


=== Failsafe ===
You can also call functions before or after each execution of the block (this means continuously on each iteration of each stage of the block, not just when entering o exiting the block).
<source lang="xml">
  <block name="circlehome" pre_call="function_to_call_before_circle()" post_call="function_to_call_after_circle()">
    <circle wp="HOME"/>
  </block>
</source>


Paparazzi provides several failsafe features, see [[Failsafe]].
=== Pre Call ===


=== Immobilize Actuators ===  
<source lang="xml">
<block name="Standby" strip_button="Standby" strip_icon="home.png" pre_call="if(!InsideKill(GetPosX(), GetPosY())) NavKillThrottle();">
</source>


h_ctl setpoints variable are set by the h_ctl_attitude_loop() (from fw_h_ctl.c) loop) which can be disabled with the
=== Post Call ===
h_ctl_disabled flag:


<set var="h_ctl_disabled" value="TRUE"/>
<source lang="xml">
  <set var="h_ctl_aileron_setpoint" value="0"/>
  <block name="traj" pre_call="formation_pre_call()" post_call="formation_flight()"> <!-- formation flight is call after all other navigation tasks -->
<set var="h_ctl_elevator_setpoint" value="MAX_PPRZ/2"/>
</source>
.... waiting for a condition ...
<set var="h_ctl_disabled" value="FALSE"/>


== Procedures ==
== Procedures ==


Procedures are libraries which can be included in flight plans. They are composed of waypoints, sectors and blocks. The header of a procedure may
Procedures are libraries which can be included in flight plans. They are composed of waypoints, sectors and blocks. The header of a procedure may contain some parameters which are replaced by arguments when the procedure is included.
contain some parameters which are replaced by arguments when the procedure is included.


Extract of the DTD: a procedure is a sequence of parameters, waypoints, ...:
Extract of the DTD: a procedure is a sequence of parameters, waypoints, ...:
<tt><!ELEMENT procedure (param*,header?,waypoints?,sectors?,exceptions?,blocks?)></tt>
<source lang="xml"><!ELEMENT procedure (param*,header?,waypoints?,sectors?,exceptions?,blocks?)></source>


A <tt>param</tt>eter is just a name. A parameter is optional if it is declared with a default value.
A <tt>param</tt>eter is just a name. A parameter is optional if it is declared with a default value.
An example with a required and an optional parameter:
An example with a required and an optional parameter:
<tt><param name="alt"/>
<source lang="xml">
<param name="radius" default_value="75"/></tt>
  <param name="alt"/>
  <param name="radius" default_value="75"/>
</source>


Procedures are called with the <tt>include</tt> element in a flight plan. A procedure cannot be included twice or by another procedure. A procedure call requires:
Procedures are called with the <tt>include</tt> element in a flight plan. A procedure cannot be included twice or by another procedure. A procedure call requires:
* the name of the procedure file, the name given to this inclusion;  
* the name of the procedure file, the name given to this inclusion;  
* values for the parameters;
* values for the parameters;
Line 352: Line 518:


For example:
For example:
<tt><include name="landing" procedure="landing.xml"/></tt>
<source lang="xml"><include name="landing" procedure="landing.xml"/></source>


Here is the corresponding procedure '''landing.xml''':
Here is the corresponding procedure '''landing.xml''':
<tt><!DOCTYPE procedure SYSTEM "flight_plan.dtd">
<source lang="xml">
<procedure>
<!DOCTYPE procedure SYSTEM "flight_plan.dtd">
  <waypoints>
  <procedure>
    <waypoint name="AF" x="177.4" y="45.1" alt="30"/>
    <waypoints>
    <waypoint name="TD" x="28.8" y="57.0" alt="0"/>
      <waypoint name="AF" x="177.4" y="45.1" alt="30"/>
    <waypoint name="_BASELEG" x="168.8" y="-13.8"/>
      <waypoint name="TD" x="28.8" y="57.0" alt="0"/>
  </waypoints>
      <waypoint name="_BASELEG" x="168.8" y="-13.8"/>
  <blocks>
    </waypoints>
    ...
    <blocks>
    <block name="land">
      ...
      <call fun="nav_compute_baseleg(WP_AF, WP_TD, WP__BASELEG, nav_radius)"/>
      <block name="land">
      <circle radius="nav_radius" until="NavCircleCount() > 0.5" wp="_BASELEG"/>
        <call fun="nav_compute_baseleg(WP_AF, WP_TD, WP__BASELEG, nav_radius)"/>
      <circle radius="nav_radius" until="And(NavQdrCloseTo(DegOfRad(baseleg_out_qdr)-10), 10 > fabs(estimator_z - WaypointAlt(WP__BASELEG)))" wp="_BASELEG"/>
        <circle radius="nav_radius" until="NavCircleCount() > 0.5" wp="_BASELEG"/>
    </block>
        <circle radius="nav_radius" until="And(NavQdrCloseTo(DegOfRad(baseleg_out_qdr)-10), 10 > fabs(GetPosAlt()- WaypointAlt(WP__BASELEG)))" wp="_BASELEG"/>
...
      </block>
   </blocks>
      ...
</tt>
    </blocks>
   </procedure>
</source>


Note that the name of procedure '''land''' block will be renamed into '''landing.land''':
Note that the name of procedure '''land''' block will be renamed into '''landing.land''':
<tt><deroute block="landing.land"/></tt>
<source lang="xml"><deroute block="landing.land"/></source>
will jump to this procedure block.
will jump to this procedure block.


Suppose you have a go-around condition in your landing procedure. You would write it
Suppose you have a go-around condition in your landing procedure. You would write it
<tt><exception cond="..." deroute="go-around"/></tt>
<source lang="xml"><exception cond="..." deroute="go-around"/></source>
then you must link this block exit with one of your block (e.g. <tt>Standby</tt>). So you would include the procedure as follows:
then you must link this block exit with one of your block (e.g. <tt>Standby</tt>). So you would include the procedure as follows:
<tt><include name="landing" procedure="landing.xml">
<source lang="xml">
  <with from="go-around" to="Standby"/>
  <include name="landing" procedure="landing.xml">
  </include></tt>\
    <with from="go-around" to="Standby"/>
  </include>
</source>
 
== Internal Variables in Flight Plans ==
 
The flight plan can use several internal variables, macros and functions coming from the rest of the system or the flight plan API itself. The following list present some of the most commonly used variables, but much more are actually available:
 
* '''autopilot_flight_time''': time in seconds since autopilot was booted (integer)
* '''datalink_time''': time in seconds since last connection of telemetry to ground control station (including ''subsystems/datalink/datallink.h'' in the '''header''' section is required) (integer)
* '''GetPosAlt()''': returns the current altitude above ground level in meter (float)
* '''GetPosX()''': returns x (easting) of current position relative to reference in meter (float)
* '''GetPosY()''': returns y (northing) of current position relative to reference in meter (float)
* <s>'''ground_alt''': altitude above ground level in meter (float)</s> (v5.8 and higher - use '''GetAltRef()''' instead)
* '''GetAltRef()''': returns reference altitude, usually ground_alt
* '''NavSetGroundReferenceHere()''': reset position and altitude reference point to current position
* '''NavSetAltitudeReferenceHere()''': reset altitude reference to current alt but keep previous horizontal position reference
* '''NavSetWaypointHere(_wp)''': set position of a waypoint given as argument to the current position
* '''WaypointX(_wp)''': returns x (easting) of waypoint position relative to reference in meter (float)
* '''WaypointY(_wp)''': returns y (northing) of waypoint position relative to reference in meter (float)
* '''WaypointAlt(_wp)''': returns waypoint altitude in meter (float)
* '''nav_radius''': free variable usually used to set circle radius in flight plan
* '''NavKillThrottle()''': function to switch off throttle
* '''PowerVoltage()''': returns current voltage of the battery
* all functions from the [http://docs.paparazziuav.org/latest/group__state__interface.html state interface API]
* all functions from the [http://docs.paparazziuav.org/latest/subsystems_2navigation_2waypoints_8h.html waypoint API]
* all variables declared in [[modules]] headers
 
== Extentending ==
 
By adding navigaition type of modules to you airframe your flightplan options can be massively extended.
 
[[Advanced_Navigation_Routines|Take a look on this page to see which modules are on offer]]
 
In case all the basic options and modules still do not let you fly autonomous like you want to, nothing prevends you from creating andother nav module. Before you set out on that task, make sure that there really is no way or module that can make your wanted behaviour a reality.
 
== Examples ==
 
Take a good look at other flight plans included with Paparazzi, you can learn a lot from them. Be sure to also visit the [[Flight_Plan_Examples|flight plan examples]] page to enhance your knowledge on flightplans.
 
== Advanced Examples ==
 
Parameters used in a flight plan can be computed expressions. In this example, the plane is asked to perform 5 circles at progressively increasing altitudes for exactly one minute at each altitude:
<source lang="xml">
  <for var="i" from="1" to="5">
    <circle wp="HOME" radius="75"
          alt="ground_alt + 50*$i"
          until="stage_time > 60" />
  </for>
</source>
 
Below you find some random examples of the posibilities. This is only the tip of the iceberg, use your imagination and go wild with new creative ideas for your flightplan
 
=== Gains on the fly ===
 
It is very well possible to set specific gain for an airframe if it reaches e.g a certain block.
 
=== Dynacmically adjustable maximum speed ===
 
<source lang="xml">
<call_once fun="gh_set_max_speed(2.0)"/>
</source>
 
=== Immobilize Actuators ===
 
h_ctl setpoints variable are set by the h_ctl_attitude_loop() (from fw_h_ctl.c) loop) which can be disabled with the h_ctl_disabled flag:
 
<source lang="xml">
  <set var="h_ctl_disabled" value="TRUE"/>
<set var="h_ctl_aileron_setpoint" value="0"/>
<set var="h_ctl_elevator_setpoint" value="MAX_PPRZ/2"/>
.... waiting for a condition ...
<set var="h_ctl_disabled" value="FALSE"/>
</source>


== Building Flight Plans ==
== Tips and Tricks ==


'''Waypoint Settings'''
There are many ways to skin a cat just as there are many ways to craft your flight plan. Following the best practices tips can save you from a lot of frustration and mishap.


Many of the flight plan examples here and in the Paparazzi software set waypoint locations using x,y coordinates from the lat/lon in the header of the flight plan. When building flight plans on the fly where there is no requirement to stay within lat/lon boundaries, this is acceptable. When you are building flight plans where you are required to stay within or overfly certain GPS coordinates, using x,y from the lat/lon in the header will not work in real life. When simulating your flight plan the aircraft always starts from the lat/lon in the header. In reality your aircraft will probably start from a different spot each time, meaning your lat/lon coordinates will change each time. If you use the x,y coordinates, then each waypoint will move and your GPS points will not longer be correct
* Simulate your flight plan before taking it to the sky. Flight plans should always be carefully tested prior to flight, take a look at the [[Simulation|simulation]] page for details on how to simulate your plan.
* Make an subdirectory in the Flight_plan directory with your own name and add your flight plans there. Make sure that the location of the DTD is correct, e.g by using relative directory double dots as in <tt><!DOCTYPE flight_plan SYSTEM "../flight_plan.dtd"></tt>


== Flight Simulation ==
* There are several option to build failsafe features into you flightplan, [[Failsafe|for some examples visit the Failsafe page]].
Complex flight plans should always be carefully tested prior to flight. See the [[Simulation|simulation]] page for details.
* Some flight plan examples define waypoint locations using relative coordinates. These are relative positions from the fixed lat and lon in the header of the flight plan. When simulating your flight plan the aircraft always use the lat/lon as defined in the flight plan since a regular simulation has no notion of you current position of you local PC where you simulate on. This is something to keep in mind if you test your flight plan in real flights.


== See also==
=== V5.8+ ===
For example flight plans please see [[Flight_Plan_Examples|Flight_Plan_Examples]]
* If you don't like the '''No SRTM data found to check altitude''' warning, either in your flight plan editor or in GCS itself click on the '''Nav->display SRTM'''. It will ask you whether you want to download SRTM data. Say yes, and it will save the data in ''data/srtm'' directory, so you don't get the warning any more and check the ground altitude even without GPS.


[[Category:Software]] [[Category:User_Documentation]]
[[Category:Software]] [[Category:User_Documentation]]

Latest revision as of 15:08, 4 May 2021

A flight plan is a XML document which one can create and store aboard an autopilot. The flight plan will describe how you want your aircraft to travel if released into into the wild blue yonder.

DTD and Structure

The formal description of the flight plan file is given in the DTD (located in conf/flight_plans/flight_plan.dtd). This DTD must be referenced in the header of your flight plan XML document using the following line:

<!DOCTYPE flight_plan SYSTEM "flight_plan.dtd">

The flight plans are stored in the conf/flight_plans directory. The flight plan editor can be used to create basic flight plans via the GUI.

Extract from the DTD:

<!ELEMENT flight_plan (header?,waypoints,sectors?,variables?,includes?,exceptions?,blocks)>

A flight plan is composed of two mandatory elements: waypoints and blocks

The root flight_plan element is specified with several attributes:

<flight_plan name lat0 lon0 ground_alt security_height home_mode_height qfu alt max_dist_from_home>
name
The name of the mission (a text string)
lat0, lon0
Defines the latitude and longitude coordinates of the reference point {0,0} in WGS84 degree coordinates
ground_alt
The ground altitude (in meters), Above Sea Level where you are flying. It defines the GROUND_ALT constant value which can be used in combination with a waypoint <height> parameter to define a waypoint height
security_height
The height (over ground_alt) used by the circle-home failsafe procedure and in other flight procedures such as formation flight and anti-collision avoidance. Warnings are produced if you place a waypoint lower than security_height (usually the case for the landing point)
home_mode_height (optional)
This optional attribute available since v4.2 allows to override security_height as failsafe height in home mode. If home_mode_height Is set lower than security_height, the later is used. This attribute is useful if you need to return home at a high altitude rather than a low altitude.
qfu (optional)
defines the global constant QFU. It usually is the magnetic heading in degrees (north=0, east=90) of the runway, the opposite of wind direction. This constant may be used in the mission description. It is also used by the simulator as the original course of the aircraft. So if you want to take off and climb to the West you would use qfu=270.
alt
The default altitude of waypoints (Above Sea Level). So if your ground altitude is 400 then alt needs to be a value greater than ground altitude and above any obstructions in the flight plan.
max_dist_from_home
A radius representing the maximum allowed distance (in meters) from the HOME waypoint. Exceeding this value (ie flying outside the circle with this radius) will trigger an exception. It is up to you to define the block to be executed (ie what to do) for the exception.


Here is an example of such a line in the top of a flight plan:

  <flight_plan alt="250" ground_alt="185" lat0="43.46223" lon0="1.27289" name="Example Muret" max_dist_from_home="300" qfu="270" security_height="25" >

Note that a flight plan could also contain optional include's and exceptions cases.

In English the above flight plan says the name is Example Muret. The reference coordinates for the 0,0 point is: 43.46223 (lat) and 1.27289 (long). The flying site 0,0 location is 185m above sea level. The security height is 25m above 0,0 point or 210m above sea level. The default (ie if not defined in a waypoint this alt is used) altitude is 250m (above sea level). The home mode block altitude is defined to be 150m above sea level. Also, for security, a circle is defined with a radius that's 300m from 0,0 position. This is the max_dist_from_home value. Fly 301m from 0,0 and an exception is triggered. A useful block is to trigger/go to the home mode block and return to home when the aircraft flies outside the safety circle. Example flight plans are helpful for study before you build your own from scratch.

Waypoints

The waypoints are the geographic locations used to specify the trajectories. A waypoint is specified by it's name and coordinates:

 <waypoint name wpx wpy [alt] [height]/> 

where wpx and wpy are real positional coordinates ( lat/lon ) or UTM coordinates ( utm_x0/utm_y0 ) or relative coordinates ( x/y ) in meters from your reference point {0,0} . alt is an optional parameter and can be used to assign an altitude to a particular waypoint that is different from the globally defined alt parameter of the flightplan. The height attribute can be used to set the waypoint height relative to the ground altitude (ground_alt) of the flight plan for this waypoint.

An example:

  <waypoints>
    <waypoint name="HOME" x="0.0" y="30.0"/>
    <waypoint name="BRIDGEOVERRIVER" x="-100.0" y="60.0" alt="270."/>
    <waypoint name="MyBarn" x="-130.0" y="217.5" alt="3000."/>
    <waypoint name="3" x="-30.0" y="50" height="50."/>
    <waypoint name="4" x="-30.0" y="50." alt="ground_alt + 50"/>
    <waypoint name="_MYHELPERSPOT" x="-30.0" y="60" height="50."/>
    <waypoint name="_MYOTHERHELPERSPOT" x="-70.0" y="90" height="70."/>
    <waypoint name="TOWER" lat="48.858249" lon="2.294494" height="324."/>
    <waypoint name="MountainCAFE" utm_x0="360284.8" utm_y0="4813595.5" alt="1965."/>
  </waypoints>

Tips

  • Waypoints are easily adjusted with the flight plan editor.
  • If a waypoint name starts with an underscore ( _ ), the waypoint is not displayed in the GCS, except in editor mode.
  • The maximum number of waypoints is 254.
  • A waypoint named HOME is required if the failsafe HOME mode procedure is used.
  • A waypoints index/reference pointer is derived by prefixing the waypoint name with "WP_". Useful when a call function uses the waypoints reference index vs. it's name.

Sectors

Flat Sectors can be described as an area defined by a list of waypoint corners. Such an area will be displayed in the Ground Control Station (GCS) by colored lines connecting the cornerpoints. A function is generated to check if a point, usually the aircraft itself, is inside this sector. For a sector named MyBigGarden the generated function for the example here would be bool_t InsideMyBigGarden(float x, float y); where x and y are east and north coordinated, in meters, relative to the geographic reference of the flight plan. Note that sector names are not allowed to contain spaces.

Note: The edges of the polygon should not cross each other.

For example, with the following element in a flight plan.

  <sectors>
    <sector name="MyBigGarden" color="red">
      <corner name="_1"/>
      <corner name="_2"/>
      <corner name="_3"/>
      <corner name="_4"/>
    </sector>
  </sectors>


It is then possible to add an exception clause to your flightplan. For example if the aircraft for some reason flies outside this sector, the airframe will fly to a standby waypoint. The exclamation mark (!) means the boolean operator NOT in this example. In regular language one would describe "If my airframe is NOT inside the MyBigGarden sector anymore then deroute it to the standby waypoint. In Flightplan "Speak" this is written like:

 <exception cond="! InsideMyBigGarden(GetPosX(), GetPosY())" deroute="standby"/>

Tip: The color indicating the sector borders is not fixed but can be defined by oneself if wished for via the color attribute.

Before version 6.0

Before version 6.0, there was "static" and "dynamic" sectors. The default type of a sector was "static", except if the extra attribute type="dynamic" was added.

Static sectors have these limitations:

  • The polygon need to be convex and described in a clockwise order.
  • If the flight plan is dynamically relocated, such a sector will be relocated but the display is not updated on the GCS.
  • editing of the waypoints of the sector during the flight do not dynamically update the inside function. It will always check if the position is inside the original sector.


Variables

Available since v5.9

It is possible to declare a list of variables that will be automatically created during the flight plan generation and available for the rest of the system from the generated flight plan header and of course inside the flight plan itself. With appropriate attributes, it is also possible to make the variables accessible from the telemetry as a setting.

The following code will produce a float variable initialized to 0:

  <variables>
    <variable var="my_var"/>
  </variables>

The type and the initial value can be changed with the type and init attributes:

  <variables>
    <variable var="my_var" init="10" type="int"/>
  </variables>

To produce an automatic setting for a variable, at least min, max and step attributes need to be specified:

  <variables>
    <variable var="my_var" min="0." max="10." step="0.1"/>
  </variables>

They will appear under the Flight Plan settings tab in the GCS. So more attributes can be specified: shortname, unit, alt_unit, alt_unit_coef, values. See Settings page for more information about these options.

Modules

Additional modules can be added to the airframe using the modules element inside the flight plan. The same syntax is used as in the airframe file:

  <modules>
    <module name="demo_module">
      <define name="MY_DEFINE" value="0"/>
      <configure name="MY_CONF" value="0"/>
      ...
    </module>
  </modules>

Includes

include is used to add some flight plan elements defined in an external procedure. It’s useful to include pre-written procedures with only few arguments and then clarify the flight plan. Here is the structure:

<include name procedure> [<arg name value />]*[<with from to />]*</include>

where name attribute of the include element will be used in this flight plan to prefix the blocks of the procedure, the XML referenced file. Named arguments may be given with their value in the arg elements. The with tag allows to link labels (e.g. attribute of a deroute instruction or of an exception) from the procedure to blocks of the main flight plan. Then, each block of the procedure is like any block of the flight plan and is designated with a dotted identifier: block b of a procedure named p is named b.p .

Here is an example:

  <includes>
    <include name="landing" procedure="landing.xml"/>
  </includes>

Blocks

Block elements are the main part of a flight plan: they describe each unit of the mission. They are made of various primitives, called stages and exceptions, you can put one after the other. When a stage (or a block) is finished, the autopilot goes to the next one. The behaviour after the last stage of the last block is undefined.

As described in the DTD, the blocks element is composed of block elements which are sequence of stages:

  <!ELEMENT blocks (block+)>
  <!ELEMENT block  (exception|while|heading|attitude|go|xyz|set|call|circle|deroute|stay|follow|survey_rectangle|for|return|eight|oval|home|path)*>

Example:

  <block name="circlehome">
    <circle radius="75" wp="HOME"/>
  </block>

You can add a button in the strip of the aircraft with the attribute strip_button:

  <block name="descent" strip_button="Descent">
    <circle wp="HOME" throttle="0.0" pitch="-15" vmode="throttle"/>
  </block>

This button will activate the block. If the attribute group is specified, all strip buttons of the same group will be placed vertically on top of each other.

In the same way, a key shortcut can be specified:

  <block key="D" name="descent" strip_button="Descent">
    <circle wp="HOME" throttle="0.0" pitch="-15" vmode="throttle"/>
  </block>

Modifiers are allowed, using the syntax of GTK accelerators.

An icon can be specified to display the button. The strip_button label then is a tooltip for the icon. The icon must be an image file available in the directory data/pictures/gcs_icons:

<block name="Takeoff" strip_icon="takeoff.png" strip_button="Takeoff">

You can call functions before or after each execution of the block:

  <block name="circlehome" pre_call="function_to_call_before_circle()" post_call="function_to_call_after_circle()">
    <circle wp="HOME"/>
  </block>

Expressions

Most of the numeric attributes in stages are analyzed as C expressions. The syntax of this C expression is restricted to

  • numeric constants
  • some internal autopilot variables (not fully documented, see internal variables section below and other examples)
  • Some binary operators: <, >, <=, >=, <>, ==, +, -, /, *
  • Some utility functions
  • Since some operators are not very compliant with the XML specifications (especially '<'), you can use some alternate naming:
    • @LT (less than, <)
    • @GT (greater than, >)
    • @LEQ (less or equal, <=)
    • @GEQ (greater or equal, >=)
    • @AND ( && )
    • @OR ( || )
    • @DEREF ( -> )

Some examples of usable expressions are given in the next sections.

Initialization Blocks

Most flight plans will have three blocks of flight plan initialization blocks. It is good practice to follow this example below if you first start learning to create flightplans

The first block waits until the GPS fix has been established, as shown below.

  <blocks>
    <block name="Wait GPS">
      <set value="1" var="kill_throttle"/>
      <while cond="!GpsFixValid()"/>
    </block>

The second block updates the local waypoints with respect to the UAV.

    <block name="Geo init">
      <while cond="LessThan(NavBlockTime(), 10)"/>
      <call fun="NavSetGroundReferenceHere()"/>
    </block>

This next block prevents the UAV from starting the engine and taking off.

    <block name="Holding point">
      <!--set var="nav_mode" value="NAV_MODE_ROLL"/-->
      <set value="1" var="kill_throttle"/>
      <attitude roll="0" throttle="0" vmode="throttle"/>
    </block>

Exceptions

The flight manager can handle exceptions. They consist in conditions checked periodically (at the same pace as the navigation control), allowing the control to jump to a given block. Here is the syntax of exceptions:

<exception cond="..." deroute="...">

where cond is an expression and deroute is the name of the block we want to switch to as soon as the condition is true.

Here are some example of exceptions:

  <exception cond="10 > PowerVoltage()" deroute="go_down"/>
  <exception cond="(ground_alt+10 > GetPosAlt())" deroute="go_up"/>
  <exception cond="(autopilot_flight_time > 840)" deroute="quick_land"/>

Exceptions can be local to a block or global to the flight plan, in the <exceptions> element. In the following example, time since last reception of a message from the ground station is monitored and the navigation is switched to the Standby block if no message have been received for 22s. This exception is valid for all the blocks.

  <flight_plan ...>
    <waypoints> ... </waypoints>
    <exceptions>
      <exception cond="datalink_time > 22" deroute="Standby"/>
    </exceptions>
  <blocks> ...

Deroute

The deroute is the goto directive of the flight plan; it switches the navigation to the given block:

<deroute block="landing"/>

Note that this primitive should not be used to execute loops which are provided by the following elements.

Return

The return is also a goto directive that brings you back to the last block (and last stage). It has no argument.

<return/>

Loops

Unbounded loops are written with while elements whose cond attribute is a boolean expression. Children of while are stages:

  <while cond="TRUE">
    <go wp="A"/>
    <go wp="B"/> 
    <go wp="C"/>
    <while cond="5 > stage_time"/>
   </while>

In this example, we run an infinite loop, letting the aircraft try to go via waypoints A, B and C and waiting for 5 seconds before repeating.

Bounded loops are written with the for tag:

  <for var="i" from="0" to="3">
    ...
  </for>

where the body of the loop will be run four times.

The variable of a for loop can be used inside expressions appearing as attributes of the stages:

  <for var="i" from="1" to="5">
    <circle wp="HOME" radius="75" alt="ground_alt+50*$i" until="stage_time>10" />
  </for>

In this example, the aircraft will circle around waypoint HOME for 10 seconds at an altitude above ground of 50m (1x50), 10 seconds at an altitude of 100m (2x50), ... until 250m (5x50).

Note: Two bounded loops using the same control variable are not allowed in the same block. Further, I tested a specific implementation installation of PaparazziUAV v5.10 and I found the maximum range of the looping variable to be -128 to 126.

Navigation modes

Navigation modes give the description of the desired trajectory in 3D. While the horizontal mode is specified through stages, the vertical control is specified with various attributes of these stages. The current available navigation stages are

  • attitude : just keep a fixed attitude;
  • heading : keep a given course;
  • go : go to a given waypoint;
  • path : list of waypoints linked by go
  • circle : circle around a waypoint;
  • oval : two half circles with a straight between two nav points
  • eight : fly a figure of eight through a waypoint and around another
  • stay : hold the position (hard to realize for a fixed-wing aircraft);
  • follow : follow another aircraft;
  • xyz : circle around a point where XY moveable with the RC transmitter stick, Z with other stick or slider

The vertical control is achieved using the vmode attribute of these stages. The possible values are

  • alt (the default) : the autopilot keeps the desired altitude which is the altitude of the waypoint (if any) or the altitude specified with the alt attribute;
  • climb : the autopilot keeps the desired vertical speed specified with the climb attribute (in m/s);
  • throttle : the autopilots sets the desired throttle specified with the throttle attribute (between 0 and 1);
  • glide : the autopilot keeps the desired slope between two waypoints

The default control is done with the throttle. However, setting the pitch attribute to auto and the throttle attribute to a constant allows a vertical control only by controlling the attitude of the A/C. The pitch attribute also can be set to any value (in degrees) while the throttle control is in use: it usually affects the airspeed of the aircraft.

The different navigation modes are detailed in the next sections.

Attitude

Element attitude is the navigation mode which corresponds to the current lowest control loop for horizontal mode. The autopilot then keeps a constant attitude. The roll attribute is required (in degrees, positive to put right wing low).

To fly away, at constant airspeed:

<attitude roll="0" vmode="throttle", throttle="0.5"/>

To fly around, holding a given altitude:

<attitude roll="30" alt="ground_alt+50"/>

Note that it is not a safe navigation mode since the geographic position of the plane is not controlled. However, this mode is useful to tune the roll attitude control loop.

Heading

heading primitive is relative to the second level loop for horizontal mode in the autopilot which will keep the given course, a required attribute (in degrees, clockwise, north=0, east=90).

One example to takeoff, following the QFU, 80% throttle, nose up (15 degrees) until height of 30m is reached:

<heading course="QFU" vmode="throttle" throttle="0.8" pitch="15" until="(GetPosAlt() > ground_alt+30)"/>

Go

The go primitive is probably the most useful one. Basically, the autopilot will try to join a given waypoint (wp, the only required attribute). So the simplest thing you can ask for is

<go wp="HOME"/>

which will set the HOME waypoint as the desired target position. Note than since vmode="alt" is the default, the altitude of the target waypoint is also taken into account. The navigation will switch to the next stage as soon as the target is reached.

It is usually not a good idea to try to join a waypoint without asking for a precise trajectory, i.e. a given line. Setting the hmode attribute to route, the navigation will go over a segment joining two waypoints:

<go from="wp1" wp="wp2" hmode="route"/>

The target altitude is the altitude of the target waypoint; it can also be set with the alt attribute. The following example keeps an altitude with fixed throttle:

<go from="wp2" wp="wp3" hmode="route" pitch="auto" throttle="0.75" alt="ground_alt+100"/>

The attributes related to the vertical control can also be set to replace the default altitude mode:

<go from="wp1" wp="wp2" hmode="route" vmode="climb" climb="1.5"/>

Finally, the approaching_time (in seconds) attribute helps to decide when the target is reached. It can be set to 0 to go over the target waypoint (default value is the CARROT time, set in the airframe configuration file).

<go from="wp1" wp="wp2" hmode="route" approaching_time="1"/>

Path

The path primitive is just a shorthand expression for a set of go primitives. A list of waypoints defined with the wpts attribute is pre-processed into a set of go primitives with the hmode attribute. For example:

<path wpts="wp1, wp2, wp3"/>

Other attributes are optional:

<path wpts="wp3, wp1, wp2" approaching_time="1" pitch="auto" throttle="0.5"/>

Circle

The circle primitive is the second main navigation mode: the trajectory is defined as a circle around a given waypoint with a given radius:

<circle wp="HOME" radius="75"/>

A positive radius makes the UAS move clockwise, a negative counter-clockwise.

The until attribute may be used to control the end of the stage. The following example defines an ascending trajectory at constant throttle, nose up (15 degrees), over growing circles, until the battery level is low:

<circle wp="wp1" radius="50+(GetPosAlt()-ground_alt)/2" vmode="throttle" throttle="0.75" pitch="15" until="10>PowerVoltage()"/>

Oval

The oval consists of two half circles that are connected with two straight lines. This flight path is usefull when a IMU is used because the straights allow for level flight.

 <oval p1="1" p2="2" radius="nav_radius"/>

Eight

Works only for Fixed-wing! Fly a figure of eight that consists of two straight legs that pass though the center and the center of the half circle at the end of the two legs is in the turn around waypoint. The altitude of the center waypoint is used for the entire figure. The turn around waypoint is moved to match radius given.

  <eight center="1" radius="nav_radius" turn_around="2"/>

Survey rectangle

Fly a survey rectangle defined by two waypoints. The distance between the legs of the grid (in meter) and the orientation of the grid (NS or WE) can be set by the operator. The plane will turn outside of the border of the rectangle before starting a new leg.

  <survey_rectangle wp1="1" wp2="2" grid="200" orientation="NS"/>

Follow

The follow is a special primitive which makes the UAS follow another UAS (real or simulated, named with its ac_id) at a given distance (in meters) behind and at a given height (in meters) above.

In this example, the autopilot will try to follow A/C number 4, staying 50m behind and 20m above.

<follow ac_id="4" distance="50" height="20"/>

Stay

The stay Here the UAS with try to stay at the waypoint as best as it can. For an aircraft capable of hovering it will just hang above the waypoint. If the UAV has no hover capabilities,stay will mean the aircraft will constantly fly straight through the waypoint in a flower like pattern with the smallest turn radius it can manage.

<stay wp="HOME" alt="10"/>

Abide

The abide Here the UAS with try to abide at the waypoint as best as it can. For an aircraft capable only capable of hovering it will just hang above the waypoint. For a fixedwing or a Hybrid type UAV,stay will mean the aircraft will constantly fly straight through the waypoint in a flower like pattern with the smallest turn radius it can manage.

<abide wp="SAMPLEME" alt="95"/>

Note that you current Paparazzi version might not have this option yet., use stay as an alternative

XYZ

xyz is a special mode where the UAS circles around a user moveable waypoint. This waypoint is moved with the RC sticks:

  • YAW channel controls the point over the west-east axis;
  • PITCH channel controls the point over the south-north axis;
  • ROLL channel controls the altitude.

Example (default radius is 100):

<xyz radius="40"/>

Set

The set element is a dangerous one which should be used only by expert users: it is used to directly set an internal variable of the autopilot. For example, you can change the value of the default ground altitude, a variable used by the home mode failsafe procedure (and maybe by your own flight plan):

<set var="ground_alt" value="ground_alt+50"/>

This directive is extremely powerful and has great potential for error - use with caution.

Call

The call allows the user to define its own navigation procedures in C. The value must be a call to a boolean function which must return TRUE as long as the stage is not completed (a function which should be called only once would then return immediately FALSE). This feature is illustrated with the line pattern:

  <call fun="nav_line_setup()"/>
  <call fun="nav_line_run(WP_1, WP_2, nav_radius)"/>

where nav_line_setup() returns FALSE and nav_line_run() always returns TRUE (this stage never ends). Note that a waypoints index is derived/denoted by prefixing the waypoint name with WP_(i.e.: 1 --> WP_1, 2 --> WP_2)

To call any function exactly once regardless of the return value (e.g. call a void function), add loop="FALSE"

  <call fun="viewvideo_take_shot(TRUE)" loop="FALSE"/>

or use the call_once alias:

  <call_once fun="viewvideo_take_shot(TRUE)"/>

Such extra navigation functions are usually written as a Module and the header files are included automatically.

If you want to call functions that are not part of a module, you need to include the header file which contains the function declaration:or supplementary C file which must be specified in the

  <header>
#include "path/to/header.h"
  </header>

where the path is relative to the sw/airborne directory.

You can also call functions before or after each execution of the block (this means continuously on each iteration of each stage of the block, not just when entering o exiting the block).

  <block name="circlehome" pre_call="function_to_call_before_circle()" post_call="function_to_call_after_circle()">
    <circle wp="HOME"/>
  </block>

Pre Call

 <block name="Standby" strip_button="Standby" strip_icon="home.png" pre_call="if(!InsideKill(GetPosX(), GetPosY())) NavKillThrottle();">

Post Call

 <block name="traj" pre_call="formation_pre_call()" post_call="formation_flight()"> <!-- formation flight is call after all other navigation tasks -->

Procedures

Procedures are libraries which can be included in flight plans. They are composed of waypoints, sectors and blocks. The header of a procedure may contain some parameters which are replaced by arguments when the procedure is included.

Extract of the DTD: a procedure is a sequence of parameters, waypoints, ...:

<!ELEMENT procedure (param*,header?,waypoints?,sectors?,exceptions?,blocks?)>

A parameter is just a name. A parameter is optional if it is declared with a default value. An example with a required and an optional parameter:

  <param name="alt"/>
  <param name="radius" default_value="75"/>

Procedures are called with the include element in a flight plan. A procedure cannot be included twice or by another procedure. A procedure call requires:

  • the name of the procedure file, the name given to this inclusion;
  • values for the parameters;
  • backlinks for block name exits of the procedure.

For example:

<include name="landing" procedure="landing.xml"/>

Here is the corresponding procedure landing.xml:

<!DOCTYPE procedure SYSTEM "flight_plan.dtd">
  <procedure>
    <waypoints>
      <waypoint name="AF" x="177.4" y="45.1" alt="30"/>
      <waypoint name="TD" x="28.8" y="57.0" alt="0"/>
      <waypoint name="_BASELEG" x="168.8" y="-13.8"/>
    </waypoints>
    <blocks>
      ...
      <block name="land">
        <call fun="nav_compute_baseleg(WP_AF, WP_TD, WP__BASELEG, nav_radius)"/>
        <circle radius="nav_radius" until="NavCircleCount() > 0.5" wp="_BASELEG"/>
        <circle radius="nav_radius" until="And(NavQdrCloseTo(DegOfRad(baseleg_out_qdr)-10), 10 > fabs(GetPosAlt()- WaypointAlt(WP__BASELEG)))" wp="_BASELEG"/>
      </block>
      ...
    </blocks>
  </procedure>

Note that the name of procedure land block will be renamed into landing.land:

<deroute block="landing.land"/>

will jump to this procedure block.

Suppose you have a go-around condition in your landing procedure. You would write it

<exception cond="..." deroute="go-around"/>

then you must link this block exit with one of your block (e.g. Standby). So you would include the procedure as follows:

  <include name="landing" procedure="landing.xml">
    <with from="go-around" to="Standby"/>
  </include>

Internal Variables in Flight Plans

The flight plan can use several internal variables, macros and functions coming from the rest of the system or the flight plan API itself. The following list present some of the most commonly used variables, but much more are actually available:

  • autopilot_flight_time: time in seconds since autopilot was booted (integer)
  • datalink_time: time in seconds since last connection of telemetry to ground control station (including subsystems/datalink/datallink.h in the header section is required) (integer)
  • GetPosAlt(): returns the current altitude above ground level in meter (float)
  • GetPosX(): returns x (easting) of current position relative to reference in meter (float)
  • GetPosY(): returns y (northing) of current position relative to reference in meter (float)
  • ground_alt: altitude above ground level in meter (float) (v5.8 and higher - use GetAltRef() instead)
  • GetAltRef(): returns reference altitude, usually ground_alt
  • NavSetGroundReferenceHere(): reset position and altitude reference point to current position
  • NavSetAltitudeReferenceHere(): reset altitude reference to current alt but keep previous horizontal position reference
  • NavSetWaypointHere(_wp): set position of a waypoint given as argument to the current position
  • WaypointX(_wp): returns x (easting) of waypoint position relative to reference in meter (float)
  • WaypointY(_wp): returns y (northing) of waypoint position relative to reference in meter (float)
  • WaypointAlt(_wp): returns waypoint altitude in meter (float)
  • nav_radius: free variable usually used to set circle radius in flight plan
  • NavKillThrottle(): function to switch off throttle
  • PowerVoltage(): returns current voltage of the battery
  • all functions from the state interface API
  • all functions from the waypoint API
  • all variables declared in modules headers

Extentending

By adding navigaition type of modules to you airframe your flightplan options can be massively extended.

Take a look on this page to see which modules are on offer

In case all the basic options and modules still do not let you fly autonomous like you want to, nothing prevends you from creating andother nav module. Before you set out on that task, make sure that there really is no way or module that can make your wanted behaviour a reality.

Examples

Take a good look at other flight plans included with Paparazzi, you can learn a lot from them. Be sure to also visit the flight plan examples page to enhance your knowledge on flightplans.

Advanced Examples

Parameters used in a flight plan can be computed expressions. In this example, the plane is asked to perform 5 circles at progressively increasing altitudes for exactly one minute at each altitude:

  <for var="i" from="1" to="5">
    <circle wp="HOME" radius="75"
          alt="ground_alt + 50*$i"
          until="stage_time > 60" />
  </for>

Below you find some random examples of the posibilities. This is only the tip of the iceberg, use your imagination and go wild with new creative ideas for your flightplan

Gains on the fly

It is very well possible to set specific gain for an airframe if it reaches e.g a certain block.

Dynacmically adjustable maximum speed

<call_once fun="gh_set_max_speed(2.0)"/>

Immobilize Actuators

h_ctl setpoints variable are set by the h_ctl_attitude_loop() (from fw_h_ctl.c) loop) which can be disabled with the h_ctl_disabled flag:

 <set var="h_ctl_disabled" value="TRUE"/>
 <set var="h_ctl_aileron_setpoint" value="0"/>
 <set var="h_ctl_elevator_setpoint" value="MAX_PPRZ/2"/>
 .... waiting for a condition ...
 <set var="h_ctl_disabled" value="FALSE"/>

Tips and Tricks

There are many ways to skin a cat just as there are many ways to craft your flight plan. Following the best practices tips can save you from a lot of frustration and mishap.

  • Simulate your flight plan before taking it to the sky. Flight plans should always be carefully tested prior to flight, take a look at the simulation page for details on how to simulate your plan.
  • Make an subdirectory in the Flight_plan directory with your own name and add your flight plans there. Make sure that the location of the DTD is correct, e.g by using relative directory double dots as in <!DOCTYPE flight_plan SYSTEM "../flight_plan.dtd">
  • There are several option to build failsafe features into you flightplan, for some examples visit the Failsafe page.
  • Some flight plan examples define waypoint locations using relative coordinates. These are relative positions from the fixed lat and lon in the header of the flight plan. When simulating your flight plan the aircraft always use the lat/lon as defined in the flight plan since a regular simulation has no notion of you current position of you local PC where you simulate on. This is something to keep in mind if you test your flight plan in real flights.

V5.8+

  • If you don't like the No SRTM data found to check altitude warning, either in your flight plan editor or in GCS itself click on the Nav->display SRTM. It will ask you whether you want to download SRTM data. Say yes, and it will save the data in data/srtm directory, so you don't get the warning any more and check the ground altitude even without GPS.