Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
tcas.c File Reference

Collision avoidance library. More...

#include "multi/tcas.h"
#include "state.h"
#include "firmwares/fixedwing/nav.h"
#include "generated/flight_plan.h"
#include "modules/datalink/downlink.h"
Include dependency graph for tcas.c:

Go to the source code of this file.

Macros

#define TCAS_TAU_TA   2*CARROT
#define TCAS_TAU_RA   CARROT
#define TCAS_DMOD   10.
#define TCAS_ALIM   15.
#define TCAS_DT_MAX   1500
#define TCAS_HUGE_TAU   100*TCAS_TAU_TA
#define TCAS_IsInside()

Functions

void callTCAS (void)
void tcas_init (void)
void parseTcasResolve (uint8_t *buf)
void parseTcasRA (uint8_t *buf)
static enum tcas_resolve tcas_test_direction (uint8_t id)
void tcas_periodic_task_1Hz (void)
void tcas_periodic_task_4Hz (void)

Variables

float tcas_alt_setpoint
float tcas_tau_ta
float tcas_tau_ra
float tcas_dmod
float tcas_alim
uint8_t tcas_status
enum tcas_resolve tcas_resolve
uint8_t tcas_ac_RA
struct tcas_ac_status tcas_acs_status [NB_ACS]

Detailed Description

Collision avoidance library.

Definition in file tcas.c.

Macro Definition Documentation

◆ TCAS_ALIM

#define TCAS_ALIM   15.

Definition at line 56 of file tcas.c.

Referenced by tcas_init().

◆ TCAS_DMOD

#define TCAS_DMOD   10.

Definition at line 52 of file tcas.c.

Referenced by tcas_init().

◆ TCAS_DT_MAX

#define TCAS_DT_MAX   1500

Definition at line 60 of file tcas.c.

Referenced by tcas_periodic_task_1Hz().

◆ TCAS_HUGE_TAU

#define TCAS_HUGE_TAU   100*TCAS_TAU_TA

Definition at line 63 of file tcas.c.

Referenced by tcas_periodic_task_1Hz().

◆ TCAS_IsInside

#define TCAS_IsInside ( )
Value:
( (ddh < Square(tcas_dmod) && ddv < Square(2*tcas_alim)) ? 1 : 0 )
#define Square(_x)
Definition nav.h:53
float tcas_alim
Definition tcas.c:36
float tcas_dmod
Definition tcas.c:36

Definition at line 68 of file tcas.c.

Referenced by tcas_periodic_task_1Hz().

◆ TCAS_TAU_RA

#define TCAS_TAU_RA   CARROT

Definition at line 48 of file tcas.c.

Referenced by tcas_init().

◆ TCAS_TAU_TA

#define TCAS_TAU_TA   2*CARROT

Definition at line 44 of file tcas.c.

Referenced by tcas_init().

Function Documentation

◆ callTCAS()

void callTCAS ( void )

Definition at line 65 of file tcas.c.

References tcas_alt_setpoint, TCAS_RA, tcas_status, and v_ctl_altitude_setpoint.

Referenced by navigation_task().

Here is the caller graph for this function:

◆ parseTcasRA()

void parseTcasRA ( uint8_t * buf)

Definition at line 95 of file tcas.c.

References tcas_acs_status, and ti_acs_id.

◆ parseTcasResolve()

void parseTcasResolve ( uint8_t * buf)

Definition at line 87 of file tcas.c.

References tcas_acs_status, and ti_acs_id.

◆ tcas_init()

◆ tcas_periodic_task_1Hz()

◆ tcas_periodic_task_4Hz()

void tcas_periodic_task_4Hz ( void )

◆ tcas_test_direction()

enum tcas_resolve tcas_test_direction ( uint8_t id)
inlinestatic

Definition at line 103 of file tcas.c.

References acInfoGetPositionEnu_f(), RA_CLIMB, RA_DESCEND, stateGetPositionEnu_f(), tcas_alim, and EnuCoor_f::z.

Referenced by tcas_periodic_task_1Hz().

Here is the call graph for this function:
Here is the caller graph for this function:

Variable Documentation

◆ tcas_ac_RA

uint8_t tcas_ac_RA

Definition at line 40 of file tcas.c.

Referenced by tcas_init(), tcas_periodic_task_1Hz(), and tcas_periodic_task_4Hz().

◆ tcas_acs_status

struct tcas_ac_status tcas_acs_status[NB_ACS]

Definition at line 41 of file tcas.c.

Referenced by parseTcasRA(), parseTcasResolve(), tcas_init(), and tcas_periodic_task_1Hz().

◆ tcas_alim

float tcas_alim

Definition at line 36 of file tcas.c.

Referenced by tcas_init(), tcas_periodic_task_4Hz(), and tcas_test_direction().

◆ tcas_alt_setpoint

float tcas_alt_setpoint

Definition at line 35 of file tcas.c.

Referenced by callTCAS(), tcas_init(), and tcas_periodic_task_4Hz().

◆ tcas_dmod

float tcas_dmod

Definition at line 36 of file tcas.c.

Referenced by tcas_init().

◆ tcas_resolve

Definition at line 39 of file tcas.c.

◆ tcas_status

uint8_t tcas_status

Definition at line 38 of file tcas.c.

Referenced by callTCAS(), tcas_init(), tcas_periodic_task_1Hz(), and tcas_periodic_task_4Hz().

◆ tcas_tau_ra

float tcas_tau_ra

Definition at line 36 of file tcas.c.

Referenced by tcas_init(), and tcas_periodic_task_1Hz().

◆ tcas_tau_ta

float tcas_tau_ta

Definition at line 36 of file tcas.c.

Referenced by tcas_init(), and tcas_periodic_task_1Hz().