You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
362 lines
9.1 KiB
362 lines
9.1 KiB
|
|
#ifdef _WIN32
|
|
#define _CRT_SECURE_NO_WARNINGS
|
|
#endif
|
|
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <stdarg.h>
|
|
#include <usrsctp.h>
|
|
|
|
#ifndef _WIN32
|
|
#include <sys/time.h>
|
|
#include <arpa/inet.h>
|
|
#else
|
|
#include <sys/types.h>
|
|
#include <sys/timeb.h>
|
|
#include <io.h>
|
|
#endif
|
|
|
|
#include "programs_helper.h"
|
|
|
|
#ifdef _WIN32
|
|
static void
|
|
gettimeofday(struct timeval *tv, void *ignore)
|
|
{
|
|
struct timeb tb;
|
|
|
|
ftime(&tb);
|
|
tv->tv_sec = (long)tb.time;
|
|
tv->tv_usec = (long)(tb.millitm) * 1000L;
|
|
}
|
|
#endif
|
|
|
|
void
|
|
debug_printf_runtime(void) {
|
|
static struct timeval time_main;
|
|
struct timeval time_now;
|
|
struct timeval time_delta;
|
|
|
|
if (time_main.tv_sec == 0 && time_main.tv_usec == 0) {
|
|
gettimeofday(&time_main, NULL);
|
|
}
|
|
|
|
gettimeofday(&time_now, NULL);
|
|
timersub(&time_now, &time_main, &time_delta);
|
|
|
|
fprintf(stderr, "[%u.%03u] ", (unsigned int) time_delta.tv_sec, (unsigned int) time_delta.tv_usec / 1000);
|
|
}
|
|
|
|
|
|
void
|
|
debug_printf_stack(const char *format, ...)
|
|
{
|
|
va_list ap;
|
|
char charbuf[1024];
|
|
static struct timeval time_main;
|
|
struct timeval time_now;
|
|
struct timeval time_delta;
|
|
|
|
if (time_main.tv_sec == 0 && time_main.tv_usec == 0) {
|
|
gettimeofday(&time_main, NULL);
|
|
}
|
|
|
|
gettimeofday(&time_now, NULL);
|
|
timersub(&time_now, &time_main, &time_delta);
|
|
|
|
va_start(ap, format);
|
|
if (vsnprintf(charbuf, 1024, format, ap) < 0) {
|
|
charbuf[0] = '\0';
|
|
}
|
|
va_end(ap);
|
|
|
|
fprintf(stderr, "[S][%u.%03u] %s", (unsigned int) time_delta.tv_sec, (unsigned int) time_delta.tv_usec / 1000, charbuf);
|
|
}
|
|
|
|
static void
|
|
handle_association_change_event(struct sctp_assoc_change *sac)
|
|
{
|
|
unsigned int i, n;
|
|
|
|
fprintf(stderr, "Association change ");
|
|
switch (sac->sac_state) {
|
|
case SCTP_COMM_UP:
|
|
fprintf(stderr, "SCTP_COMM_UP");
|
|
break;
|
|
case SCTP_COMM_LOST:
|
|
fprintf(stderr, "SCTP_COMM_LOST");
|
|
break;
|
|
case SCTP_RESTART:
|
|
fprintf(stderr, "SCTP_RESTART");
|
|
break;
|
|
case SCTP_SHUTDOWN_COMP:
|
|
fprintf(stderr, "SCTP_SHUTDOWN_COMP");
|
|
break;
|
|
case SCTP_CANT_STR_ASSOC:
|
|
fprintf(stderr, "SCTP_CANT_STR_ASSOC");
|
|
break;
|
|
default:
|
|
fprintf(stderr, "UNKNOWN");
|
|
break;
|
|
}
|
|
fprintf(stderr, ", streams (in/out) = (%u/%u)",
|
|
sac->sac_inbound_streams, sac->sac_outbound_streams);
|
|
n = sac->sac_length - sizeof(struct sctp_assoc_change);
|
|
if (((sac->sac_state == SCTP_COMM_UP) ||
|
|
(sac->sac_state == SCTP_RESTART)) && (n > 0)) {
|
|
fprintf(stderr, ", supports");
|
|
for (i = 0; i < n; i++) {
|
|
switch (sac->sac_info[i]) {
|
|
case SCTP_ASSOC_SUPPORTS_PR:
|
|
fprintf(stderr, " PR");
|
|
break;
|
|
case SCTP_ASSOC_SUPPORTS_AUTH:
|
|
fprintf(stderr, " AUTH");
|
|
break;
|
|
case SCTP_ASSOC_SUPPORTS_ASCONF:
|
|
fprintf(stderr, " ASCONF");
|
|
break;
|
|
case SCTP_ASSOC_SUPPORTS_MULTIBUF:
|
|
fprintf(stderr, " MULTIBUF");
|
|
break;
|
|
case SCTP_ASSOC_SUPPORTS_RE_CONFIG:
|
|
fprintf(stderr, " RE-CONFIG");
|
|
break;
|
|
case SCTP_ASSOC_SUPPORTS_INTERLEAVING:
|
|
fprintf(stderr, " INTERLEAVING");
|
|
break;
|
|
default:
|
|
fprintf(stderr, " UNKNOWN(0x%02x)", sac->sac_info[i]);
|
|
break;
|
|
}
|
|
}
|
|
} else if (((sac->sac_state == SCTP_COMM_LOST) ||
|
|
(sac->sac_state == SCTP_CANT_STR_ASSOC)) && (n > 0)) {
|
|
fprintf(stderr, ", ABORT =");
|
|
for (i = 0; i < n; i++) {
|
|
fprintf(stderr, " 0x%02x", sac->sac_info[i]);
|
|
}
|
|
}
|
|
fprintf(stderr, ".\n");
|
|
return;
|
|
}
|
|
|
|
static void
|
|
handle_peer_address_change_event(struct sctp_paddr_change *spc)
|
|
{
|
|
char addr_buf[INET6_ADDRSTRLEN];
|
|
const char *addr;
|
|
struct sockaddr_in *sin;
|
|
struct sockaddr_in6 *sin6;
|
|
struct sockaddr_conn *sconn;
|
|
|
|
switch (spc->spc_aaddr.ss_family) {
|
|
case AF_INET:
|
|
sin = (struct sockaddr_in *)&spc->spc_aaddr;
|
|
addr = inet_ntop(AF_INET, &sin->sin_addr, addr_buf, INET_ADDRSTRLEN);
|
|
break;
|
|
case AF_INET6:
|
|
sin6 = (struct sockaddr_in6 *)&spc->spc_aaddr;
|
|
addr = inet_ntop(AF_INET6, &sin6->sin6_addr, addr_buf, INET6_ADDRSTRLEN);
|
|
break;
|
|
case AF_CONN:
|
|
sconn = (struct sockaddr_conn *)&spc->spc_aaddr;
|
|
#ifdef _WIN32
|
|
if (_snprintf(addr_buf, INET6_ADDRSTRLEN, "%p", sconn->sconn_addr) < 0) {
|
|
#else
|
|
if (snprintf(addr_buf, INET6_ADDRSTRLEN, "%p", sconn->sconn_addr) < 0) {
|
|
#endif
|
|
addr_buf[0] = '\0';
|
|
}
|
|
addr = addr_buf;
|
|
break;
|
|
default:
|
|
#ifdef _WIN32
|
|
if (_snprintf(addr_buf, INET6_ADDRSTRLEN, "Unknown family %d", spc->spc_aaddr.ss_family) < 0) {
|
|
#else
|
|
if (snprintf(addr_buf, INET6_ADDRSTRLEN, "Unknown family %d", spc->spc_aaddr.ss_family) < 0) {
|
|
#endif
|
|
addr_buf[0] = '\0';
|
|
}
|
|
addr = addr_buf;
|
|
break;
|
|
}
|
|
fprintf(stderr, "Peer address %s is now ", addr);
|
|
switch (spc->spc_state) {
|
|
case SCTP_ADDR_AVAILABLE:
|
|
fprintf(stderr, "SCTP_ADDR_AVAILABLE");
|
|
break;
|
|
case SCTP_ADDR_UNREACHABLE:
|
|
fprintf(stderr, "SCTP_ADDR_UNREACHABLE");
|
|
break;
|
|
case SCTP_ADDR_REMOVED:
|
|
fprintf(stderr, "SCTP_ADDR_REMOVED");
|
|
break;
|
|
case SCTP_ADDR_ADDED:
|
|
fprintf(stderr, "SCTP_ADDR_ADDED");
|
|
break;
|
|
case SCTP_ADDR_MADE_PRIM:
|
|
fprintf(stderr, "SCTP_ADDR_MADE_PRIM");
|
|
break;
|
|
case SCTP_ADDR_CONFIRMED:
|
|
fprintf(stderr, "SCTP_ADDR_CONFIRMED");
|
|
break;
|
|
default:
|
|
fprintf(stderr, "UNKNOWN");
|
|
break;
|
|
}
|
|
fprintf(stderr, " (error = 0x%08x).\n", spc->spc_error);
|
|
return;
|
|
}
|
|
|
|
static void
|
|
handle_send_failed_event(struct sctp_send_failed_event *ssfe)
|
|
{
|
|
size_t i, n;
|
|
|
|
if (ssfe->ssfe_flags & SCTP_DATA_UNSENT) {
|
|
fprintf(stderr, "Unsent ");
|
|
}
|
|
if (ssfe->ssfe_flags & SCTP_DATA_SENT) {
|
|
fprintf(stderr, "Sent ");
|
|
}
|
|
if (ssfe->ssfe_flags & ~(SCTP_DATA_SENT | SCTP_DATA_UNSENT)) {
|
|
fprintf(stderr, "(flags = %x) ", ssfe->ssfe_flags);
|
|
}
|
|
fprintf(stderr, "message with PPID = %u, SID = %u, flags: 0x%04x due to error = 0x%08x",
|
|
ntohl(ssfe->ssfe_info.snd_ppid), ssfe->ssfe_info.snd_sid,
|
|
ssfe->ssfe_info.snd_flags, ssfe->ssfe_error);
|
|
n = ssfe->ssfe_length - sizeof(struct sctp_send_failed_event);
|
|
for (i = 0; i < n; i++) {
|
|
fprintf(stderr, " 0x%02x", ssfe->ssfe_data[i]);
|
|
}
|
|
fprintf(stderr, ".\n");
|
|
return;
|
|
}
|
|
|
|
static void
|
|
handle_adaptation_indication(struct sctp_adaptation_event *sai)
|
|
{
|
|
fprintf(stderr, "Adaptation indication: %x.\n", sai-> sai_adaptation_ind);
|
|
return;
|
|
}
|
|
|
|
static void
|
|
handle_shutdown_event(struct sctp_shutdown_event *sse)
|
|
{
|
|
fprintf(stderr, "Shutdown event.\n");
|
|
/* XXX: notify all channels. */
|
|
return;
|
|
}
|
|
|
|
static void
|
|
handle_stream_reset_event(struct sctp_stream_reset_event *strrst)
|
|
{
|
|
uint32_t n, i;
|
|
|
|
n = (strrst->strreset_length - sizeof(struct sctp_stream_reset_event)) / sizeof(uint16_t);
|
|
fprintf(stderr, "Stream reset event: flags = %x, ", strrst->strreset_flags);
|
|
if (strrst->strreset_flags & SCTP_STREAM_RESET_INCOMING_SSN) {
|
|
if (strrst->strreset_flags & SCTP_STREAM_RESET_OUTGOING_SSN) {
|
|
fprintf(stderr, "incoming/");
|
|
}
|
|
fprintf(stderr, "incoming ");
|
|
}
|
|
if (strrst->strreset_flags & SCTP_STREAM_RESET_OUTGOING_SSN) {
|
|
fprintf(stderr, "outgoing ");
|
|
}
|
|
fprintf(stderr, "stream ids = ");
|
|
for (i = 0; i < n; i++) {
|
|
if (i > 0) {
|
|
fprintf(stderr, ", ");
|
|
}
|
|
fprintf(stderr, "%d", strrst->strreset_stream_list[i]);
|
|
}
|
|
fprintf(stderr, ".\n");
|
|
return;
|
|
}
|
|
|
|
static void
|
|
handle_stream_change_event(struct sctp_stream_change_event *strchg)
|
|
{
|
|
fprintf(stderr, "Stream change event: streams (in/out) = (%u/%u), flags = %x.\n",
|
|
strchg->strchange_instrms, strchg->strchange_outstrms, strchg->strchange_flags);
|
|
return;
|
|
}
|
|
|
|
static void
|
|
handle_remote_error_event(struct sctp_remote_error *sre)
|
|
{
|
|
size_t i, n;
|
|
|
|
n = sre->sre_length - sizeof(struct sctp_remote_error);
|
|
fprintf(stderr, "Remote Error (error = 0x%04x): ", sre->sre_error);
|
|
for (i = 0; i < n; i++) {
|
|
fprintf(stderr, " 0x%02x", sre-> sre_data[i]);
|
|
}
|
|
fprintf(stderr, ".\n");
|
|
return;
|
|
}
|
|
|
|
void
|
|
handle_notification(union sctp_notification *notif, size_t n)
|
|
{
|
|
if (notif->sn_header.sn_length != (uint32_t)n) {
|
|
return;
|
|
}
|
|
|
|
fprintf(stderr, "handle_notification : ");
|
|
|
|
switch (notif->sn_header.sn_type) {
|
|
case SCTP_ASSOC_CHANGE:
|
|
fprintf(stderr, "SCTP_ASSOC_CHANGE\n");
|
|
handle_association_change_event(&(notif->sn_assoc_change));
|
|
break;
|
|
case SCTP_PEER_ADDR_CHANGE:
|
|
fprintf(stderr, "SCTP_PEER_ADDR_CHANGE\n");
|
|
handle_peer_address_change_event(&(notif->sn_paddr_change));
|
|
break;
|
|
case SCTP_REMOTE_ERROR:
|
|
fprintf(stderr, "SCTP_REMOTE_ERROR\n");
|
|
handle_remote_error_event(&(notif->sn_remote_error));
|
|
break;
|
|
case SCTP_SHUTDOWN_EVENT:
|
|
fprintf(stderr, "SCTP_SHUTDOWN_EVENT\n");
|
|
handle_shutdown_event(&(notif->sn_shutdown_event));
|
|
break;
|
|
case SCTP_ADAPTATION_INDICATION:
|
|
fprintf(stderr, "SCTP_ADAPTATION_INDICATION\n");
|
|
handle_adaptation_indication(&(notif->sn_adaptation_event));
|
|
break;
|
|
case SCTP_PARTIAL_DELIVERY_EVENT:
|
|
fprintf(stderr, "SCTP_PARTIAL_DELIVERY_EVENT\n");
|
|
break;
|
|
case SCTP_AUTHENTICATION_EVENT:
|
|
fprintf(stderr, "SCTP_AUTHENTICATION_EVENT\n");
|
|
break;
|
|
case SCTP_SENDER_DRY_EVENT:
|
|
fprintf(stderr, "SCTP_SENDER_DRY_EVENT\n");
|
|
break;
|
|
case SCTP_NOTIFICATIONS_STOPPED_EVENT:
|
|
fprintf(stderr, "SCTP_NOTIFICATIONS_STOPPED_EVENT\n");
|
|
break;
|
|
case SCTP_SEND_FAILED_EVENT:
|
|
fprintf(stderr, "SCTP_SEND_FAILED_EVENT\n");
|
|
handle_send_failed_event(&(notif->sn_send_failed_event));
|
|
break;
|
|
case SCTP_STREAM_RESET_EVENT:
|
|
fprintf(stderr, "SCTP_STREAM_RESET_EVENT\n");
|
|
handle_stream_reset_event(&(notif->sn_strreset_event));
|
|
break;
|
|
case SCTP_ASSOC_RESET_EVENT:
|
|
fprintf(stderr, "SCTP_ASSOC_RESET_EVENT\n");
|
|
break;
|
|
case SCTP_STREAM_CHANGE_EVENT:
|
|
fprintf(stderr, "SCTP_STREAM_CHANGE_EVENT\n");
|
|
handle_stream_change_event(&(notif->sn_strchange_event));
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|