Mirrors_Framework/paparazzi
1
0
Fork 0
mirror of https://github.com/paparazzi/paparazzi.git synced 2026-06-06 16:58:48 +08:00
Code Issues Actions 29 Packages Projects Releases Wiki Activity

added error counter

Browse Source
This commit is contained in:
Antoine Drouin
2010-08-12 00:48:19 +00:00
parent db6513c729
commit a71ee037e1
1 changed files with 23 additions and 34 deletions
Download Patch File Download Diff File Expand all files Collapse all files
sw/airborne/lisa/lisa_overo_link.h
+23 -34
View File
@@ -5,23 +5,24 @@
#include "fms/fms_autopilot_msg.h"
enum LisaOveroLinkStatus {IDLE, BUSY, DATA_AVAILABLE, LOST};
enum LisaOveroLinkStatus {IDLE, BUSY, DATA_AVAILABLE, LOST, CRC_ERROR};
#define OVERO_LINK_TIMEOUT 10
struct LisaOveroLink {
volatile uint8_t status;
union {
struct OVERO_LINK_MSG_UP msg;
uint8_t array[sizeof(union AutopilotMessage)];
} up;
union {
struct OVERO_LINK_MSG_DOWN msg;
uint8_t array[sizeof(union AutopilotMessage)];
} down;
uint8_t timeout;
volatile uint8_t status;
uint32_t msg_cnt;
uint32_t crc_err_cnt;
union {
struct OVERO_LINK_MSG_UP msg;
uint8_t array[sizeof(union AutopilotMessage)];
} up;
union {
struct OVERO_LINK_MSG_DOWN msg;
uint8_t array[sizeof(union AutopilotMessage)];
} down;
uint8_t timeout;
uint8_t crc_error;
};
extern struct LisaOveroLink overo_link;
@@ -35,31 +36,19 @@ extern void overo_link_arch_prepare_next_transfert(void);
#include "lisa_overo_link_arch.h"
#define OveroLinkPeriodic(_timeout_handler) { \
if (overo_link.timeout < OVERO_LINK_TIMEOUT) \
overo_link.timeout++; \
else { \
if (overo_link.status != LOST) { \
overo_link.status = LOST; \
LED_OFF(OVERO_LINK_LED_OK); \
LED_ON(OVERO_LINK_LED_KO); \
_timeout_handler(); \
} \
} \
#define OveroLinkPeriodic(_timeout_handler) { \
if (overo_link.timeout < OVERO_LINK_TIMEOUT) \
overo_link.timeout++; \
else { \
if (overo_link.status != LOST && overo_link.status != CRC_ERROR) { \
overo_link.status = LOST; \
LED_OFF(OVERO_LINK_LED_OK); \
LED_ON(OVERO_LINK_LED_KO); \
_timeout_handler(); \
} \
} \
}
#if 0
#define OveroLinkEvent(_data_received_handler) { \
if (overo_link.status == DATA_AVAILABLE) { \
overo_link.timeout = 0; \
LED_TOGGLE(OVERO_LINK_LED_OK); \
LED_OFF(OVERO_LINK_LED_KO); \
_data_received_handler(); \
overo_link_arch_prepare_next_transfert(); \
overo_link.status = IDLE; \
} \
}
#endif
/*