Difference between revisions of "MultiUAV"

From PaparazziUAV
Jump to navigation Jump to search
Line 16: Line 16:
* alt_setpoint is bounded by (ground_alt + security_height)
* alt_setpoint is bounded by (ground_alt + security_height)
The control of the TCAS will be active until the conflict is solved, no longer exist or a timeout occurs.
The control of the TCAS will be active until the conflict is solved, no longer exist or a timeout occurs.
On top of this, the resolution is sent to the conflicting UAV (relayed by the ground). In case of conflict on the first resolution (ex: the 2 UAVs are climbing), one of them will decide to change its decision.
[[File:tcas_nego.png]]


=== Activate TCAS service ===
=== Activate TCAS service ===


The traffic_info service must be activated with the TCAS:
The traffic_info service must be activated with the TCAS (compile flag TRAFFIC_INFO). This service is activated by default for the fixed wing aircraft and is not implemented yet on rotorcraft.


  ap.CFLAGS += -DTRAFFIC_INFO -DTCAS
The TCAS is activated by loading the appropriate module in the '''modules''' section (see [[Modules]] page):
   ap.srcs += traffic_info.c tcas.c
   <load name="tcas.xml"/>


The TCAS system is operational only in AUTO2 and in altitude mode. The system is inhibited under the security height.
The TCAS system is operational only in AUTO2 and in altitude mode. The system is inhibited under the security height.
Line 32: Line 36:
     <define name="TAU_RA" value="6." unit="s"/> <!-- resolution advisory -->
     <define name="TAU_RA" value="6." unit="s"/> <!-- resolution advisory -->
     <define name="ALIM" value="15." unit="m"/> <!-- altitude limit -->
     <define name="ALIM" value="15." unit="m"/> <!-- altitude limit -->
    <define name="DMOD" value="10." unit="m"/> <!-- distance modification -->
     <define name="DT_MAX" value="2000" unit="ms"/> <!-- lost comm or timeout -->
     <define name="DT_MAX" value="2000" unit="ms"/> <!-- lost comm or timeout -->
   </section>
   </section>
Line 38: Line 43:
* '''TAU_RA''': resolution advisory in second. A warning message is send to the ground (+ display in GCS) and the system takes control over the altitude setpoint of the vertical loop if the estimated time before a collision is below TAU_RA. Default = CARROT.
* '''TAU_RA''': resolution advisory in second. A warning message is send to the ground (+ display in GCS) and the system takes control over the altitude setpoint of the vertical loop if the estimated time before a collision is below TAU_RA. Default = CARROT.
* '''ALIM''': altitude limit in meters. The minimum vertical separation between two aircraft. Default = 10.
* '''ALIM''': altitude limit in meters. The minimum vertical separation between two aircraft. Default = 10.
* '''DMOD''': distance modification in meters. The distance below which RA are triggered (avoid to have two aircraft getting really close because their relative speed is too small to trigger alarms). Default = 10.
* '''DT_MAX''': lost comm or timeout in ms. Timeout to interrupt a TA or an RA if data are not received. Default = 1500.
* '''DT_MAX''': lost comm or timeout in ms. Timeout to interrupt a TA or an RA if data are not received. Default = 1500.



Revision as of 08:07, 13 March 2012

WARNING: the functionalities described in this section are experimental and have never been fully tested. Use with care !


TCAS

Principle

Trajectories of 2 UAVs using the TCAS system

The TCAS (Traffic Collision Avoidance System) is used on civil aircraft to reduce the incidence of mid-air collisions. The principle is to monitor the airspace around the aircraft, warn the pilot and provide conflict resolution indication. For the Paparazzi system, a light version of a TCAS-inspired system has been implemented. It can send warning to the ground station and if nothing is done, it takes control of the vertical loop in order to have a minimum vertical separation. This TCAS monitors all the aircrafts based on the traffic information send by the Server and it resolve conflicts only with one aircraft at a time.

When the system detects a possible collision, the TCAS logic follows the rules:

  • if other_AC_alt > AC_alt + alt_limit then the AC goes down (alt_setpoint = MIN(nav_alt, other_AC_alt - alt_limit))
  • if other_AC_alt < AC_alt - alt_limit then the AC goes up (alt_setpoint = MAX(nav_alt, other_AC_alt + alt_limit))
  • else the AC with the smallest ID goes down
  • alt_setpoint is bounded by (ground_alt + security_height)

The control of the TCAS will be active until the conflict is solved, no longer exist or a timeout occurs.

On top of this, the resolution is sent to the conflicting UAV (relayed by the ground). In case of conflict on the first resolution (ex: the 2 UAVs are climbing), one of them will decide to change its decision.

Tcas nego.png

Activate TCAS service

The traffic_info service must be activated with the TCAS (compile flag TRAFFIC_INFO). This service is activated by default for the fixed wing aircraft and is not implemented yet on rotorcraft.

The TCAS is activated by loading the appropriate module in the modules section (see Modules page):

 <load name="tcas.xml"/>

The TCAS system is operational only in AUTO2 and in altitude mode. The system is inhibited under the security height.

Configuration

 <section name="TCAS" prefix="TCAS_">
   <define name="TAU_TA" value="10." unit="s"/> 
   <define name="TAU_RA" value="6." unit="s"/> 
   <define name="ALIM" value="15." unit="m"/> 
   <define name="DMOD" value="10." unit="m"/> 
   <define name="DT_MAX" value="2000" unit="ms"/> 
 </section>
  • TAU_TA: traffic advisory in second. A warning message is send to the ground and displayed in the alert page of the GCS if the estimated time before a collision is below TAU_TA. Default = 2*CARROT.
  • TAU_RA: resolution advisory in second. A warning message is send to the ground (+ display in GCS) and the system takes control over the altitude setpoint of the vertical loop if the estimated time before a collision is below TAU_RA. Default = CARROT.
  • ALIM: altitude limit in meters. The minimum vertical separation between two aircraft. Default = 10.
  • DMOD: distance modification in meters. The distance below which RA are triggered (avoid to have two aircraft getting really close because their relative speed is too small to trigger alarms). Default = 10.
  • DT_MAX: lost comm or timeout in ms. Timeout to interrupt a TA or an RA if data are not received. Default = 1500.


Formation Flight

Coming soon, hopefully