PierMesh
/
direwolf
mirror of https://github.com/wb2osz/direwolf.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity
direwolf/src/tnctest.c

1285 lines
31 KiB
C
Raw Normal View History

Add IL2P.
2021-10-22 21:29:20 +00:00
//
// This file is part of Dire Wolf, an amateur radio packet TNC.
//
// Copyright (C) 2016 John Langner, WB2OSZ
//
// This program is free software: you can redistribute it and/or modify
// it under the terms of the GNU General Public License as published by
// the Free Software Foundation, either version 2 of the License, or
// (at your option) any later version.
//
// This program is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
// GNU General Public License for more details.
//
// You should have received a copy of the GNU General Public License
// along with this program. If not, see <http://www.gnu.org/licenses/>.
//
/*------------------------------------------------------------------
*
* Module: tnctest.c
*
* Purpose: Test AX.25 connected mode between two TNCs.
*
* Description: The first TNC will connect to the second TNC and send a bunch of data.
* Proper transfer of data will be verified.
*
* Usage: tnctest [options] port0=name0 port1=name1
*
* Example: tnctest localhost:8000=direwolf COM1=KPC-3+
*
* Each port can have the following forms:
*
* * host-name:tcp-port
* * ip-addr:tcp-port
* * tcp-port
* * serial port name (e.g. COM1, /dev/ttyS0)
*
*---------------------------------------------------------------*/
/*
* Native Windows: Use the Winsock interface.
* Linux: Use the BSD socket interface.
*/
#include "direwolf.h" // Sets _WIN32_WINNT for XP API level needed by ws2tcpip.h
#if __WIN32__
#include <winsock2.h>
#include <ws2tcpip.h> // _WIN32_WINNT must be set to 0x0501 before including this
#else
#include <stdlib.h>
#include <stddef.h>
#include <netdb.h>
#include <sys/types.h>
#include <sys/ioctl.h>
#include <sys/socket.h>
#include <arpa/inet.h>
#include <netinet/in.h>
#include <netinet/tcp.h>
#include <fcntl.h>
//#include <termios.h>
#include <sys/errno.h>
#endif
#include <unistd.h>
#include <stdio.h>
#include <assert.h>
#include <ctype.h>
#include <string.h>
#include <time.h>
//#include "ax25_pad.h"
#include "textcolor.h"
#include "dtime_now.h"
#include "serial_port.h"
/* We don't deal with big-endian processors here. */
/* TODO: Use agwlib (which did not exist when this was written) */
/* rather than duplicating the effort here. */
struct agwpe_s {
#if 1
unsigned char portx; /* 0 for first, 1 for second, etc. */
unsigned char reserved1;
unsigned char reserved2;
unsigned char reserved3;
unsigned char datakind; /* message type, usually written as a letter. */
unsigned char reserved4;
unsigned char pid;
unsigned char reserved5;
#else
short portx; /* 0 for first, 1 for second, etc. */
short port_hi_reserved;
short kind_lo; /* message type */
short kind_hi;
#endif
char call_from[10];
char call_to[10];
int data_len; /* Number of data bytes following. */
int user_reserved;
};
#if __WIN32__
static unsigned __stdcall tnc_thread_net (void *arg);
static unsigned __stdcall tnc_thread_serial (void *arg);
#else
static void * tnc_thread_net (void *arg);
static void * tnc_thread_serial (void *arg);
#endif
static void tnc_connect (int from, int to);
static void tnc_disconnect (int from, int to);
static void tnc_send_data (int from, int to, char * data);
static void tnc_reset (int from, int to);
/*
* Convert Internet address to text.
* Can't use InetNtop because it is supported only on Windows Vista and later.
*/
static char * ia_to_text (int Family, void * pAddr, char * pStringBuf, size_t StringBufSize)
{
struct sockaddr_in *sa4;
struct sockaddr_in6 *sa6;
switch (Family) {
case AF_INET:
sa4 = (struct sockaddr_in *)pAddr;
#if __WIN32__
snprintf (pStringBuf, StringBufSize, "%d.%d.%d.%d", sa4->sin_addr.S_un.S_un_b.s_b1,
sa4->sin_addr.S_un.S_un_b.s_b2,
sa4->sin_addr.S_un.S_un_b.s_b3,
sa4->sin_addr.S_un.S_un_b.s_b4);
#else
inet_ntop (AF_INET, &(sa4->sin_addr), pStringBuf, StringBufSize);
#endif
break;
case AF_INET6:
sa6 = (struct sockaddr_in6 *)pAddr;
#if __WIN32__
snprintf (pStringBuf, StringBufSize, "%x:%x:%x:%x:%x:%x:%x:%x",
ntohs(((unsigned short *)(&(sa6->sin6_addr)))[0]),
ntohs(((unsigned short *)(&(sa6->sin6_addr)))[1]),
ntohs(((unsigned short *)(&(sa6->sin6_addr)))[2]),
ntohs(((unsigned short *)(&(sa6->sin6_addr)))[3]),
ntohs(((unsigned short *)(&(sa6->sin6_addr)))[4]),
ntohs(((unsigned short *)(&(sa6->sin6_addr)))[5]),
ntohs(((unsigned short *)(&(sa6->sin6_addr)))[6]),
ntohs(((unsigned short *)(&(sa6->sin6_addr)))[7]));
#else
inet_ntop (AF_INET6, &(sa6->sin6_addr), pStringBuf, StringBufSize);
#endif
break;
default:
snprintf (pStringBuf, StringBufSize, "Invalid address family!");
}
assert (strlen(pStringBuf) < StringBufSize);
return pStringBuf;
}
/*------------------------------------------------------------------
*
* Name: main
*
* Purpose: Basic test for connected AX.25 data mode between TNCs.
*
* Usage: Described above.
*
*---------------------------------------------------------------*/
#define MAX_TNC 2 // Just 2 for now.
// Could be more later for multiple concurrent connections.
/* Obtained from the command line. */
static int num_tnc; /* How many TNCs for this test? */
/* Initially only 2 but long term we might */
/* enhance it to allow multiple concurrent connections. */
static char hostname[MAX_TNC][50]; /* DNS host name or IPv4 address. */
/* Some of the code is there for IPv6 but */
/* needs more work. */
/* Defaults to "localhost" if not specified. */
static char port[MAX_TNC][30]; /* If it begins with a digit, it is considered */
/* a TCP port number at the hostname. */
/* Otherwise, we treat it as a serial port name. */
static char description[MAX_TNC][50]; /* Name used in the output. */
static int using_tcp[MAX_TNC]; /* Are we using TCP or serial port for each TNC? */
/* Use corresponding one of the next two. */
static int server_sock[MAX_TNC]; /* File descriptor for AGW socket interface. */
/* Set to -1 if not used. */
/* (Don't use SOCKET type because it is unsigned.) */
static MYFDTYPE serial_fd[MAX_TNC]; /* Serial port handle. */
static volatile int busy[MAX_TNC]; /* True when TNC busy and can't accept more data. */
/* For serial port, this is set by XON / XOFF characters. */
#define XOFF 0x13
#define XON 0x11
static char tnc_address[MAX_TNC][12]; /* Name of the TNC used in the frames. Originally, this */
/* was simply TNC0 and TNC1 but that can get hard to read */
/* and confusing. Later used DW0, DW1, for direwolf */
/* so the direction of flow is easier to grasp. */
#if __WIN32__
static HANDLE tnc_th[MAX_TNC];
#else
static pthread_t tnc_tid[MAX_TNC];
#endif
#define LINE_WIDTH 80
//#define LINE_WIDTH 120 /* If I was more ambitious I might try to get */
/* this from the terminal properties. */
static int column_width; /* Line width divided by number of TNCs. */
/*
* Current state for each TNC.
*/
static int is_connected[MAX_TNC]; /* -1 = not yet available. */
/* 0 = not connected. */
/* 1 = not connected. */
static int have_cmd_prompt[MAX_TNC]; /* Set if "cmd:" was the last thing seen. */
static int last_rec_seq[MAX_TNC]; /* Each data packet will contain a sequence number. */
/* This is used to verify that all have been */
/* received in the correct order. */
/*
* Start time so we can print relative elapsed time.
*/
static double start_dtime;
static int max_count;
int main (int argc, char *argv[])
{
int j;
int timeout;
int send_count = 0;
int burst_size = 1;
int errors = 0;
//max_count = 20;
max_count = 200;
//max_count = 6;
max_count = 1000;
max_count = 9999;
#if __WIN32__
#else
int e;
setlinebuf (stdout);
#endif
start_dtime = dtime_now();
/*
* Extract command line args.
*/
num_tnc = argc - 1;
if (num_tnc < 2 || num_tnc > MAX_TNC) {
printf ("Specify minimum 2, maximum %d TNCs on the command line.\n", MAX_TNC);
exit (EXIT_FAILURE);
}
column_width = LINE_WIDTH / num_tnc;
for (j=0; j<num_tnc; j++) {
char stemp[100];
char *p;
/* Each command line argument should be of the form "port=description." */
strlcpy (stemp, argv[j+1], sizeof(stemp));
p = strtok (stemp, "=");
if (p == NULL) {
printf ("Internal error 1\n");
exit (EXIT_FAILURE);
}
strlcpy (hostname[j], "localhost", sizeof(hostname[j]));
strlcpy (port[j], p, sizeof(port[j]));
p = strtok (NULL, "=");
if (p == NULL) {
printf ("Missing description after %s\n", port[j]);
exit (EXIT_FAILURE);
}
strlcpy (description[j], p, sizeof(description[j]));
/* If the port contains ":" split it into hostname (or addr) and port number. */
/* Haven't thought about IPv6 yet. */
strlcpy (stemp, port[j], sizeof(stemp));
char *h;
h = strtok (stemp, ":");
if (h != NULL) {
p = strtok (NULL, ":");
if (p != NULL) {
strlcpy (hostname[j], h, sizeof(hostname[j]));
strlcpy (port[j], p, sizeof(port[j]));
}
}
}
for (j=0; j<num_tnc; j++) {
is_connected[j] = -1; /* not yet available. */
last_rec_seq[j] = 0;
server_sock[j] = -1;
}
for (j=0; j<num_tnc; j++) {
/* If port begins with digit, consider it to be TCP. */
/* Otherwise, treat as serial port name. */
using_tcp[j] = isdigit(port[j][0]);
/* Addresses to use in the AX.25 frames. */
if (using_tcp[j]) {
snprintf (tnc_address[j], sizeof(tnc_address[j]), "DW%d", j);
}
else {
snprintf (tnc_address[j], sizeof(tnc_address[j]), "TNC%d", j);
}
#if __WIN32__
if (using_tcp[j]) {
tnc_th[j] = (HANDLE)_beginthreadex (NULL, 0, tnc_thread_net, (void*)(ptrdiff_t)j, 0, NULL);
}
else {
tnc_th[j] = (HANDLE)_beginthreadex (NULL, 0, tnc_thread_serial, (void*)(ptrdiff_t)j, 0, NULL);
}
if (tnc_th[j] == NULL) {
printf ("Internal error: Could not create TNC thread %d.\n", j);
exit (EXIT_FAILURE);
}
#else
if (using_tcp[j]) {
e = pthread_create (&tnc_tid[j], NULL, tnc_thread_net, (void*)(ptrdiff_t)j);
}
else {
e = pthread_create (&tnc_tid[j], NULL, tnc_thread_serial, (void*)(ptrdiff_t)j);
}
if (e != 0) {
perror("Internal error: Could not create TNC thread.");
exit (EXIT_FAILURE);
}
#endif
}
/*
* Wait until all TNCs are available.
*/
int ready = 0;
while ( ! ready) {
SLEEP_MS(100);
ready = 1;
for (j=0; j<num_tnc; j++) {
if (is_connected[j] < 0) ready = 0;
}
}
printf ("Andiamo!\n");
/*
* First, establish a connection from TNC number 0 to the other(s).
* Wait until successful.
*/
printf ("Trying to establish connection...\n");
tnc_connect (0, 1);
timeout = 600;
ready = 0;
while ( ! ready && timeout > 0) {
SLEEP_MS(100);
timeout--;
ready = 1;
for (j=0; j<num_tnc; j++) {
if (is_connected[j] <= 0) ready = 0;
}
}
if (timeout == 0) {
printf ("ERROR: Gave up waiting for connect!\n");
tnc_disconnect (1,0); // Tell other TNC.
SLEEP_MS(5000);
printf ("TEST FAILED!\n");
exit (EXIT_FAILURE);
}
/*
* Send data.
*/
SLEEP_MS(2000);
SLEEP_MS(2000);
printf ("Send data...\n");
while ( send_count < max_count) {
char data[80];
int n;
for (n = 1; n <= burst_size && send_count < max_count; n++) {
send_count++;
snprintf (data, sizeof(data), "%04d send data\r", send_count);
tnc_send_data (0, 1, data);
}
SLEEP_MS(3000 + 1000 * burst_size);
//SLEEP_MS(3000 + 500 * burst_size); // OK for low error rate
//SLEEP_MS(3000 + 3000 * burst_size);
//SLEEP_MS(3000);
burst_size++;
}
/*
* Hang around until we get last expected reply or there is too much time with no activity.
*/
int last0 = last_rec_seq[0];
int last1 = last_rec_seq[1];
int no_activity = 0;
#define INACTIVE_TIMEOUT 120
while (last_rec_seq[0] != max_count && no_activity < INACTIVE_TIMEOUT) {
SLEEP_MS(1000);
no_activity++;
if (last_rec_seq[0] > last0) {
last0 = last_rec_seq[0];
no_activity = 0;
}
if (last_rec_seq[1] > last1) {
last1 = last_rec_seq[1];
no_activity = 0;
}
}
if (last_rec_seq[0] == max_count) {
printf ("Got last expected reply.\n");
}
else {
printf ("ERROR: Timeout - No incoming activity for %d seconds.\n", no_activity);
errors++;
}
/*
* Did we get all expected replies?
*/
if (last_rec_seq[0] != max_count) {
printf ("ERROR: Last received reply was %d when we were expecting %d.\n", last_rec_seq[0], max_count);
errors++;
}
/*
* Ask for disconnect. Wait until complete.
*/
tnc_disconnect (0, 1);
timeout = 200; // 20 sec should be generous.
ready = 0;
while ( ! ready && timeout > 0) {
SLEEP_MS(100);
timeout--;
ready = 1;
for (j=0; j<num_tnc; j++) {
if (is_connected[j] != 0) ready = 0;
}
}
if (timeout == 0) {
printf ("ERROR: Gave up waiting for disconnect!\n");
tnc_reset (1,0); // Don't leave TNC in bad state for next time.
SLEEP_MS(10000);
errors++;
}
if (errors != 0) {
printf ("TEST FAILED!\n");
exit (EXIT_FAILURE);
}
printf ("Success!\n");
exit (EXIT_SUCCESS);
}
/*-------------------------------------------------------------------
*
* Name: process_rec_data
*
* Purpose: Look for our data with text sequence numbers, not to be
* confused with the AX.25 I frame sequence numbers.
*
* Inputs: my_index - 0 for the call originator.
* >1 for the other end which answers.
*
* data - Should look something like this:
* 9999 send data
* 9999 reply
*
* Global In/Out: last_rec_seq[my_index]
*
* Description: Look for expected format.
* Extract the sequence number.
* Verify that it is the next expected one.
* Update it.
*
*--------------------------------------------------------------------*/
void process_rec_data (int my_index, char *data)
{
int n;
if (isdigit(*data) && strncmp(data+4, " send", 5) == 0) {
if (my_index > 0) {
last_rec_seq[my_index]++;
n = atoi(data);
if (n != last_rec_seq[my_index]) {
printf ("%*s%s: Received %d when %d was expected.\n", my_index*column_width, "", tnc_address[my_index], n, last_rec_seq[my_index]);
SLEEP_MS(10000);
printf ("TEST FAILED!\n");
exit (EXIT_FAILURE);
}
}
}
else if (isdigit(*data) && strncmp(data+4, " reply", 6) == 0) {
if (my_index == 0) {
last_rec_seq[my_index]++;
n = atoi(data);
if (n != last_rec_seq[my_index]) {
printf ("%*s%s: Received %d when %d was expected.\n", my_index*column_width, "", tnc_address[my_index], n, last_rec_seq[my_index]);
SLEEP_MS(10000);
printf ("TEST FAILED!\n");
exit (EXIT_FAILURE);
}
}
}
else if (data[0] == 'A') {
if (strncmp(data, "ABCDEFGHIJKLMNOPQRSTUVWXYZ", strlen(data)-1) != 0) {
printf ("%*s%s: Segmentation is broken.\n", my_index*column_width, "", tnc_address[my_index]);
SLEEP_MS(10000);
printf ("TEST FAILED!\n");
exit (EXIT_FAILURE);
}
}
}
/*-------------------------------------------------------------------
*
* Name: tnc_thread_net
*
* Purpose: Establish connection with a TNC via network.
*
* Inputs: arg - My instance index, 0 thru MAX_TNC-1.
*
* Outputs: packets - Received packets are put in the corresponding column
* and sent to a common function to check that they
* all arrived in order.
*
* Global Out: is_connected - Updated when connected/disconnected notfications are received.
*
* Description: Perform any necessary configuration for the TNC then wait
* for responses and process them.
*
*--------------------------------------------------------------------*/
#define MAX_HOSTS 30
#if __WIN32__
static unsigned __stdcall tnc_thread_net (void *arg)
#else
static void * tnc_thread_net (void *arg)
#endif
{
int my_index;
struct addrinfo hints;
struct addrinfo *ai_head = NULL;
struct addrinfo *ai;
struct addrinfo *hosts[MAX_HOSTS];
int num_hosts, n;
int err;
char ipaddr_str[46]; /* text form of IP address */
#if __WIN32__
WSADATA wsadata;
#endif
struct agwpe_s mon_cmd;
char data[4096];
double dnow;
my_index = (int)(ptrdiff_t)arg;
#if DEBUGx
printf ("DEBUG: tnc_thread_net %d start, port = '%s'\n", my_index, port[my_index]);
#endif
#if __WIN32__
err = WSAStartup (MAKEWORD(2,2), &wsadata);
if (err != 0) {
printf("WSAStartup failed: %d\n", err);
return (0);
}
if (LOBYTE(wsadata.wVersion) != 2 || HIBYTE(wsadata.wVersion) != 2) {
printf("Could not find a usable version of Winsock.dll\n");
WSACleanup();
//sleep (1);
return (0);
}
#endif
memset (&hints, 0, sizeof(hints));
hints.ai_family = AF_UNSPEC; /* Allow either IPv4 or IPv6. */
// hints.ai_family = AF_INET; /* IPv4 only. */
hints.ai_socktype = SOCK_STREAM;
hints.ai_protocol = IPPROTO_TCP;
/*
* Connect to TNC server.
*/
ai_head = NULL;
err = getaddrinfo(hostname[my_index], port[my_index], &hints, &ai_head);
if (err != 0) {
#if __WIN32__
printf ("Can't get address for server %s, err=%d\n",
hostname[my_index], WSAGetLastError());
#else
printf ("Can't get address for server %s, %s\n",
hostname[my_index], gai_strerror(err));
#endif
freeaddrinfo(ai_head);
exit (1);
}
#if DEBUG_DNS
printf ("getaddrinfo returns:\n");
#endif
num_hosts = 0;
for (ai = ai_head; ai != NULL; ai = ai->ai_next) {
#if DEBUG_DNS
ia_to_text (ai->ai_family, ai->ai_addr, ipaddr_str, sizeof(ipaddr_str));
printf (" %s\n", ipaddr_str);
#endif
hosts[num_hosts] = ai;
if (num_hosts < MAX_HOSTS) num_hosts++;
}
#if DEBUG_DNS
printf ("addresses for hostname:\n");
for (n=0; n<num_hosts; n++) {
ia_to_text (hosts[n]->ai_family, hosts[n]->ai_addr, ipaddr_str, sizeof(ipaddr_str));
printf (" %s\n", ipaddr_str);
}
#endif
// Try each address until we find one that is successful.
for (n=0; n<num_hosts; n++) {
#if __WIN32__
SOCKET is;
#else
int is;
#endif
ai = hosts[n];
ia_to_text (ai->ai_family, ai->ai_addr, ipaddr_str, sizeof(ipaddr_str));
is = socket(ai->ai_family, ai->ai_socktype, ai->ai_protocol);
#if __WIN32__
if (is == INVALID_SOCKET) {
printf ("Socket creation failed, err=%d", WSAGetLastError());
WSACleanup();
is = -1;
continue;
}
#else
if (err != 0) {
printf ("Socket creation failed, err=%s", gai_strerror(err));
(void) close (is);
is = -1;
continue;
}
#endif
#ifndef DEBUG_DNS
err = connect(is, ai->ai_addr, (int)ai->ai_addrlen);
#if __WIN32__
if (err == SOCKET_ERROR) {
#if DEBUGx
printf("Connect to %s on %s (%s), port %s failed.\n",
description[my_index], hostname[my_index], ipaddr_str, port[my_index]);
#endif
closesocket (is);
is = -1;
continue;
}
#else
if (err != 0) {
#if DEBUGx
printf("Connect to %s on %s (%s), port %s failed.\n",
description[my_index], hostname[my_index], ipaddr_str, port[my_index]);
#endif
(void) close (is);
is = -1;
continue;
}
int flag = 1;
err = setsockopt (is, IPPROTO_TCP, TCP_NODELAY, (void*)(long)(&flag), (socklen_t)sizeof(flag));
if (err < 0) {
printf("setsockopt TCP_NODELAY failed.\n");
}
#endif
/* Success. */
server_sock[my_index] = is;
#endif
break;
}
freeaddrinfo(ai_head);
if (server_sock[my_index] == -1) {
printf("TNC %d unable to connect to %s on %s (%s), port %s\n",
my_index, description[my_index], hostname[my_index], ipaddr_str, port[my_index] );
exit (1);
}
#if 1 // Temp test just to get something.
/*
* Send command to toggle reception of frames in raw format.
*/
memset (&mon_cmd, 0, sizeof(mon_cmd));
mon_cmd.datakind = 'k';
SOCK_SEND(server_sock[my_index], (char*)(&mon_cmd), sizeof(mon_cmd));
#endif
/*
* Send command to register my callsign for incoming connect request.
* Not really needed when we initiate the connection.
*/
memset (&mon_cmd, 0, sizeof(mon_cmd));
mon_cmd.datakind = 'X';
strlcpy (mon_cmd.call_from, tnc_address[my_index], sizeof(mon_cmd.call_from));
SOCK_SEND(server_sock[my_index], (char*)(&mon_cmd), sizeof(mon_cmd));
/*
* Inform main program and observer that we are ready to go.
*/
printf("TNC %d now available. %s on %s (%s), port %s\n",
my_index, description[my_index], hostname[my_index], ipaddr_str, port[my_index] );
is_connected[my_index] = 0;
/*
* Print what we get from TNC.
*/
while (1) {
int n;
n = SOCK_RECV (server_sock[my_index], (char*)(&mon_cmd), sizeof(mon_cmd));
if (n != sizeof(mon_cmd)) {
printf ("Read error, TNC %d received %d command bytes.\n", my_index, n);
exit (1);
}
#if DEBUGx
printf ("TNC %d received '%c' data, data_len = %d\n",
my_index, mon_cmd.datakind, mon_cmd.data_len);
#endif
assert (mon_cmd.data_len >= 0 && mon_cmd.data_len < (int)(sizeof(data)));
if (mon_cmd.data_len > 0) {
n = SOCK_RECV (server_sock[my_index], data, mon_cmd.data_len);
if (n != mon_cmd.data_len) {
printf ("Read error, TNC %d received %d data bytes.\n", my_index, n);
exit (1);
}
data[mon_cmd.data_len] = '\0';
}
/*
* What did we get?
*/
dnow = dtime_now();
switch (mon_cmd.datakind) {
case 'C': // AX.25 Connection Received
printf("%*s[R %.3f] *** Connected to %s ***\n", my_index*column_width, "", dnow-start_dtime, mon_cmd.call_from);
is_connected[my_index] = 1;
break;
case 'D': // Connected AX.25 Data
printf("%*s[R %.3f] %s\n", my_index*column_width, "", dnow-start_dtime, data);
process_rec_data (my_index, data);
if (isdigit(data[0]) && isdigit(data[1]) && isdigit(data[2]) && isdigit(data[3]) &&
strncmp(data+4, " send", 5) == 0) {
// Expected message. Make sure it is expected sequence and send reply.
int n = atoi(data);
char reply[80];
sprintf (reply, "%04d reply\r", n);
tnc_send_data (my_index, 1 - my_index, reply);
// HACK!
// It gets very confusing because N(S) and N(R) are very close.
// Send a couple dozen I frames so they will be easier to distinguish visually.
// Currently don't have the same in serial port version.
// We change the length each time to test segmentation.
// Set PACLEN to some very small number like 5.
if (n == 1 && max_count > 1) {
int j;
for (j = 1; j <= 26; j++) {
sprintf (reply, "%.*s\r", j, "ABCDEFGHIJKLMNOPQRSTUVWXYZ");
tnc_send_data (my_index, 1 - my_index, reply);
}
}
}
break;
case 'd': // Disconnected
printf("%*s[R %.3f] *** Disconnected from %s ***\n", my_index*column_width, "", dnow-start_dtime, mon_cmd.call_from);
is_connected[my_index] = 0;
break;
case 'y': // Outstanding frames waiting on a Port
printf("%*s[R %.3f] *** Outstanding frames waiting %d ***\n", my_index*column_width, "", dnow-start_dtime, 123); // TODO
break;
default:
//printf("%*s[R %.3f] --- Ignoring cmd kind '%c' ---\n", my_index*column_width, "", dnow-start_dtime, mon_cmd.datakind);
break;
}
}
} /* end tnc_thread_net */
/*-------------------------------------------------------------------
*
* Name: tnc_thread_serial
*
* Purpose: Establish connection with a TNC via serial port.
*
* Inputs: arg - My instance index, 0 thru MAX_TNC-1.
*
* Outputs: packets - Received packets are put in the corresponding column
* and sent to a common function to check that they
* all arrived in order.
*
* Global Out: is_connected - Updated when connected/disconnected notfications are received.
*
* Description: Perform any necessary configuration for the TNC then wait
* for responses and process them.
*
*--------------------------------------------------------------------*/
#if __WIN32__
typedef HANDLE MYFDTYPE;
#define MYFDERROR INVALID_HANDLE_VALUE
#else
typedef int MYFDTYPE;
#define MYFDERROR (-1)
#endif
#if __WIN32__
static unsigned __stdcall tnc_thread_serial (void *arg)
#else
static void * tnc_thread_serial (void *arg)
#endif
{
int my_index = (int)(ptrdiff_t)arg;
char cmd[80];
serial_fd[my_index] = serial_port_open (port[my_index], 9600);
if (serial_fd[my_index] == MYFDERROR) {
printf("TNC %d unable to connect to %s on %s.\n",
my_index, description[my_index], port[my_index] );
exit (1);
}
/*
* Make sure we are in command mode.
*/
strcpy (cmd, "\003\rreset\r");
serial_port_write (serial_fd[my_index], cmd, strlen(cmd));
SLEEP_MS (3000);
strcpy (cmd, "echo on\r");
serial_port_write (serial_fd[my_index], cmd, strlen(cmd));
SLEEP_MS (200);
// do any necessary set up here. such as setting mycall
sprintf (cmd, "mycall %s\r", tnc_address[my_index]);
serial_port_write (serial_fd[my_index], cmd, strlen(cmd));
SLEEP_MS (200);
// Don't want to stop tty output when typing begins.
strcpy (cmd, "flow off\r");
serial_port_write (serial_fd[my_index], cmd, strlen(cmd));
strcpy (cmd, "echo off\r");
serial_port_write (serial_fd[my_index], cmd, strlen(cmd));
/* Success. */
printf("TNC %d now available. %s on %s\n",
my_index, description[my_index], port[my_index] );
is_connected[my_index] = 0;
/*
* Read and print.
*/
while (1) {
int ch;
char result[500];
int len;
int done;
len = 0;
result[len] = '\0';
done = 0;
while ( ! done) {
ch = serial_port_get1(serial_fd[my_index]);
if (ch < 0) {
printf("TNC %d fatal read error.\n", my_index);
exit (1);
}
if (ch == '\r' || ch == '\n') {
done = 1;
}
else if (ch == XOFF) {
double dnow = dtime_now();
printf("%*s[R %.3f] <XOFF>\n", my_index*column_width, "", dnow-start_dtime);
busy[my_index] = 1;
}
else if (ch == XON) {
double dnow = dtime_now();
printf("%*s[R %.3f] <XON>\n", my_index*column_width, "", dnow-start_dtime);
busy[my_index] = 0;
}
else if (isprint(ch)) {
result[len] = ch;
len++;
result[len] = '\0';
}
else {
char hex[12];
snprintf (hex, sizeof(hex), "<x%02x>", ch);
strlcat (result, hex, sizeof(result));
len = strlen(result);
}
if (strcmp(result, "cmd:") == 0) {
done = 1;
have_cmd_prompt[my_index] = 1;
}
else {
have_cmd_prompt[my_index] = 0;
}
}
if (len > 0) {
double dnow = dtime_now();
printf("%*s[R %.3f] %s\n", my_index*column_width, "", dnow-start_dtime, result);
if (strncmp(result, "*** CONNECTED", 13) == 0) {
is_connected[my_index] = 1;
}
if (strncmp(result, "*** DISCONNECTED", 16) == 0) {
is_connected[my_index] = 0;
}
if (strncmp(result, "Not while connected", 19) == 0) {
// Not expecting this.
// What to do?
}
process_rec_data (my_index, result);
if (isdigit(result[0]) && isdigit(result[1]) && isdigit(result[2]) && isdigit(result[3]) &&
strncmp(result+4, " send", 5) == 0) {
// Expected message. Make sure it is expected sequence and send reply.
int n = atoi(result);
char reply[80];
sprintf (reply, "%04d reply\r", n);
tnc_send_data (my_index, 1 - my_index, reply);
}
}
}
} /* end tnc_thread_serial */
static void tnc_connect (int from, int to)
{
double dnow = dtime_now();
printf("%*s[T %.3f] *** Send connect request ***\n", from*column_width, "", dnow-start_dtime);
if (using_tcp[from]) {
//struct agwpe_s {
// short portx; /* 0 for first, 1 for second, etc. */
// short port_hi_reserved;
// short datakind; /* message type */
// short kind_hi;
// char call_from[10];
// char call_to[10];
// int data_len; /* Number of data bytes following. */
// int user_reserved;
//};
struct agwpe_s cmd;
memset (&cmd, 0, sizeof(cmd));
cmd.datakind = 'C';
strlcpy (cmd.call_from, tnc_address[from], sizeof(cmd.call_from));
strlcpy (cmd.call_to, tnc_address[to], sizeof(cmd.call_to));
SOCK_SEND(server_sock[from], (char*)(&cmd), sizeof(cmd));
}
else {
char cmd[80];
if (! have_cmd_prompt[from]) {
SLEEP_MS (1500);
strcpy (cmd, "\003\003\003");
serial_port_write (serial_fd[from], cmd, strlen(cmd));
SLEEP_MS (1500);
strcpy (cmd, "\r");
serial_port_write (serial_fd[from], cmd, strlen(cmd));
SLEEP_MS (200);
}
sprintf (cmd, "connect %s\r", tnc_address[to]);
serial_port_write (serial_fd[from], cmd, strlen(cmd));
}
} /* end tnc_connect */
static void tnc_disconnect (int from, int to)
{
double dnow = dtime_now();
printf("%*s[T %.3f] *** Send disconnect request ***\n", from*column_width, "", dnow-start_dtime);
if (using_tcp[from]) {
struct agwpe_s cmd;
memset (&cmd, 0, sizeof(cmd));
cmd.datakind = 'd';
strlcpy (cmd.call_from, tnc_address[from], sizeof(cmd.call_from));
strlcpy (cmd.call_to, tnc_address[to], sizeof(cmd.call_to));
SOCK_SEND(server_sock[from], (char*)(&cmd), sizeof(cmd));
}
else {
char cmd[80];
if (! have_cmd_prompt[from]) {
SLEEP_MS (1500);
strcpy (cmd, "\003\003\003");
serial_port_write (serial_fd[from], cmd, strlen(cmd));
SLEEP_MS (1500);
strcpy (cmd, "\r");
serial_port_write (serial_fd[from], cmd, strlen(cmd));
SLEEP_MS (200);
}
strcpy (cmd, "disconnect\r");
serial_port_write (serial_fd[from], cmd, strlen(cmd));
}
} /* end tnc_disconnect */
static void tnc_reset (int from, int to)
{
double dnow = dtime_now();
printf("%*s[T %.3f] *** Send reset ***\n", from*column_width, "", dnow-start_dtime);
if (using_tcp[from]) {
}
else {
char cmd[80];
SLEEP_MS (1500);
strcpy (cmd, "\003\003\003");
serial_port_write (serial_fd[from], cmd, strlen(cmd));
SLEEP_MS (1500);
strcpy (cmd, "\r");
serial_port_write (serial_fd[from], cmd, strlen(cmd));
SLEEP_MS (200);
strcpy (cmd, "reset\r");
serial_port_write (serial_fd[from], cmd, strlen(cmd));
}
} /* end tnc_disconnect */
static void tnc_send_data (int from, int to, char * data)
{
double dnow = dtime_now();
printf("%*s[T %.3f] %s\n", from*column_width, "", dnow-start_dtime, data);
if (using_tcp[from]) {
struct {
struct agwpe_s hdr;
char data[256];
} cmd;
memset (&cmd.hdr, 0, sizeof(cmd.hdr));
cmd.hdr.datakind = 'D';
cmd.hdr.pid = 0xf0;
snprintf (cmd.hdr.call_from, sizeof(cmd.hdr.call_from), "%s", tnc_address[from]);
snprintf (cmd.hdr.call_to, sizeof(cmd.hdr.call_to), "%s", tnc_address[to]);
cmd.hdr.data_len = strlen(data);
strlcpy (cmd.data, data, sizeof(cmd.data));
SOCK_SEND(server_sock[from], (char*)(&cmd), sizeof(cmd.hdr) + strlen(data));
}
else {
// The assumption is that we are in CONVERS mode.
// The data sould be terminated by carriage return.
int timeout = 600; // 60 sec. I've seen it take more than 20.
while (timeout > 0 && busy[from]) {
SLEEP_MS(100);
timeout--;
}
if (timeout == 0) {
printf ("ERROR: Gave up waiting while TNC busy.\n");
tnc_disconnect (0,1);
SLEEP_MS(5000);
printf ("TEST FAILED!\n");
exit (EXIT_FAILURE);
}
else {
serial_port_write (serial_fd[from], data, strlen(data));
}
}
} /* end tnc_disconnect */
/* end tnctest.c */