|
|
@ -97,6 +97,14 @@ void mavlink_logbuffer_vasprintf(struct mavlink_logbuffer *lb, int severity, con |
|
|
|
lb->elems[end].severity = severity; |
|
|
|
lb->elems[end].severity = severity; |
|
|
|
vsnprintf(lb->elems[end].text, sizeof(lb->elems[0].text), fmt, ap); |
|
|
|
vsnprintf(lb->elems[end].text, sizeof(lb->elems[0].text), fmt, ap); |
|
|
|
va_end(ap); |
|
|
|
va_end(ap); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* increase count */ |
|
|
|
|
|
|
|
if (mavlink_logbuffer_is_full(lb)) { |
|
|
|
|
|
|
|
lb->start = (lb->start + 1) % lb->size; /* full, overwrite */ |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
} else { |
|
|
|
|
|
|
|
++lb->count; |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
__EXPORT void mavlink_vasprintf(int _fd, int severity, const char *fmt, ...) |
|
|
|
__EXPORT void mavlink_vasprintf(int _fd, int severity, const char *fmt, ...) |
|
|
|