viz1090/planeObj.c

102 lines
2.2 KiB
C
Raw Normal View History

#include "structs.h"
#include "dump1090.h"
struct planeObj *findPlaneObj(uint32_t addr) {
struct planeObj *p = planes;
while(p) {
if (p->addr == addr) return (p);
p = p->next;
}
return (NULL);
}
struct planeObj *createPlaneObj(struct aircraft *a) {
struct planeObj *p = (struct planeObj *) malloc(sizeof(*p));
memset(p, 0, sizeof(*p));
p->addr = a->addr;
p->created = 0;
p->oldIdx = 0;
memset(p->oldLon, 0, sizeof(p->oldLon));
memset(p->oldLat, 0, sizeof(p->oldLat));
memset(p->oldHeading, 0, sizeof(p->oldHeading));
memset(p->messageRate, 0, sizeof(p->messageRate));
return (p);
}
void updatePlanes() {
struct aircraft *a = Modes.aircrafts;
struct planeObj *p = planes;
while(p) {
p->live = 0;
p = p->next;
}
while(a) {
p = findPlaneObj(a->addr);
if (!p) {
p = createPlaneObj(a);
p->next = planes;
planes = p;
}
p->live = 1;
if(p->seen == a->seen) {
a = a->next;
continue;
}
memcpy(p->flight, a->flight, sizeof(p->flight));
memcpy(p->signalLevel, a->signalLevel, sizeof(p->signalLevel));
p->altitude = a->altitude;
p->speed = a->speed;
p->track = a->track;
p->vert_rate = a->vert_rate;
p->seen = a->seen;
p->lon = a->lon;
p->lat = a->lat;
if(time(NULL) - p->oldSeen[p->oldIdx] > TRAIL_TTL_STEP) {
p->oldIdx = (p->oldIdx+1) % 32;
p->oldLon[p->oldIdx] = p->lon;
p->oldLat[p->oldIdx] = p->lat;
p->oldHeading[p->oldIdx] = p->track;
p->oldSeen[p->oldIdx] = p->seen;
}
a = a->next;
}
p = planes;
struct planeObj *prev = NULL;
while(p) {
if(!p->live) {
if (!prev) {
planes = p->next;
free(p);
p = planes;
} else {
prev->next = p->next;
free(p);
p = prev->next;
}
} else {
prev = p;
p = p->next;
}
}
}