Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
formation.h
Go to the documentation of this file.
1
5
6
7#ifndef FORMATION_H
8#define FORMATION_H
9
10#include "generated/airframe.h" // AC_ID
12
13#define FORM_MODE_GLOBAL 0
14#define FORM_MODE_COURSE 1
15
17extern float form_prox;
18extern uint8_t form_mode;
19extern uint8_t leader_id;
20
22
23struct slot_ {
25 float east;
26 float north;
27 float alt;
28};
29
30extern struct slot_ formation[];
31
32extern int formation_init(void);
33
34extern int add_slot(uint8_t _id, float slot_e, float slot_n, float slot_a);
35
36static inline void updateSlot(uint8_t id, float se, float sn, float sa)
37{
38 formation[ti_acs_id[id]].east = se;
39 formation[ti_acs_id[id]].north = sn;
40 formation[ti_acs_id[id]].alt = sa;
41}
42
43static inline void updateFormationStatus(uint8_t id, uint8_t status) { formation[ti_acs_id[id]].status = status; }
44
45static inline void parseFormationStatus(uint8_t *buf)
46{
47 uint8_t ac_id = DL_FORMATION_STATUS_ac_id(buf);
48 uint8_t leader = DL_FORMATION_STATUS_leader_id(buf);
49 uint8_t status = DL_FORMATION_STATUS_status(buf);
50 if (ac_id == AC_ID) { leader_id = leader; }
51 else if (leader == leader_id) { updateFormationStatus(ac_id, status); }
52 else { updateFormationStatus(ac_id, UNSET); }
53}
54
55static inline void parseFormationSlot(uint8_t *buf)
56{
57 uint8_t ac_id = DL_FORMATION_SLOT_ac_id(buf);
58 uint8_t mode = DL_FORMATION_SLOT_mode(buf);
59 float slot_east = DL_FORMATION_SLOT_slot_east(buf);
60 float slot_north = DL_FORMATION_SLOT_slot_north(buf);
61 float slot_alt = DL_FORMATION_SLOT_slot_alt(buf);
62 updateSlot(ac_id, slot_east, slot_north, slot_alt);
63 if (ac_id == leader_id) { form_mode = mode; }
64}
65
66extern int start_formation(void);
67extern int stop_formation(void);
68extern int formation_flight(void);
69extern void formation_pre_call(void);
70
71#endif /* FORMATION_H */
static uint8_t status
float coef_form_pos
Definition formation.c:24
float coef_form_course
Definition formation.c:26
uint8_t leader_id
Definition formation.c:29
struct slot_ formation[NB_ACS]
Definition formation.c:32
uint8_t form_mode
Definition formation.c:28
float coef_form_speed
Definition formation.c:25
float form_prox
Definition formation.c:23
float coef_form_alt
Definition formation.c:27
static void parseFormationSlot(uint8_t *buf)
Definition formation.h:55
enum slot_status status
Definition formation.h:24
int formation_flight(void)
Definition formation.c:124
slot_status
Definition formation.h:21
@ LOST
Definition formation.h:21
@ ACTIVE
Definition formation.h:21
@ UNSET
Definition formation.h:21
@ IDLE
Definition formation.h:21
float alt
Definition formation.h:27
float east
Definition formation.h:25
static void updateSlot(uint8_t id, float se, float sn, float sa)
Definition formation.h:36
int add_slot(uint8_t _id, float slot_e, float slot_n, float slot_a)
Definition formation.c:80
int start_formation(void)
Definition formation.c:91
float north
Definition formation.h:26
static void updateFormationStatus(uint8_t id, uint8_t status)
Definition formation.h:43
static void parseFormationStatus(uint8_t *buf)
Definition formation.h:45
int formation_init(void)
Definition formation.c:62
void formation_pre_call(void)
Definition formation.c:254
int stop_formation(void)
Definition formation.c:106
uint8_t ti_acs_id[NB_ACS_ID]
static uint8_t mode
mode holds the current sonar mode mode = 0 used at high altitude, uses 16 wave patterns mode = 1 used...
Definition sonar_bebop.c:65
unsigned char uint8_t
Typedef defining 8 bit unsigned char type.