qttermtcp/ax25.c

2988 lines
65 KiB
C
Raw Normal View History

2022-08-30 11:28:28 +01:00
/*
Copyright (C) 2019-2020 Andrei Kopanchuk UZ7HO
This file is part of QtSoundModem
QtSoundModem 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 3 of the License, or
(at your option) any later version.
QtSoundModem 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 QtSoundModem. If not, see http://www.gnu.org/licenses
*/
// UZ7HO Soundmodem Port by John Wiseman G8BPQ
#include "ax25.h"
#include <stdarg.h>
#ifdef WIN32
__declspec(dllimport) unsigned short __stdcall htons(__in unsigned short hostshort);
__declspec(dllimport) unsigned short __stdcall ntohs(__in unsigned short hostshort);
#else
#define strtok_s strtok_r
#include <stddef.h>
#endif
void decode_frame(Byte * frame, int len, Byte * path, string * data,
Byte * pid, Byte * nr, Byte * ns, Byte * f_type, Byte * f_id,
Byte * rpt, Byte * pf, Byte * cr);
void SetSessLabel(void * Sess, char * label);
void setMenus(int State);
/*
unit ax25;
interface
uses classes,sysutils,windows;
procedure get_exclude_list(line: string; var list: TStringList);
procedure get_exclude_frm(line: string; var list: TStringList);
procedure get_monitor_path(path: string; var mycall,corrcall,digi: string);
procedure get_call(src_call: string; var call: string);
procedure get_call_fm_path(path: string; var callto,callfrom: string);
procedure set_corrcall(snd_ch,port: byte; path: string);
procedure set_mycall(snd_ch,port: byte; path: string);
procedure set_digi(snd_ch,port: byte; path: string);
procedure decode_frame(frame: string; var path,data: string; var pid,nr,ns,f_type,f_id: byte; var rpt,pf,cr: boolean);
procedure del_incoming_mycalls(src_call: string);
procedure del_incoming_mycalls_by_sock(socket: integer);
procedure ax25_info_init(snd_ch,port: byte);
procedure write_ax25_info(snd_ch,port: byte);
procedure clr_frm_win(snd_ch,port: byte);
procedure ax25_init;
procedure ax25_free;
function dec2hex(value: byte): string;
function get_corrcall(path: string): string;
function get_mycall(path: string): string;
function get_digi(path: string): string;
function is_excluded_call(snd_ch: byte; path: string): boolean;
function is_excluded_frm(snd_ch,f_id: byte; data: string): boolean;
function is_last_digi(path: string): boolean;
function is_digi(snd_ch,port: byte; path: string): boolean;
function is_corrcall(snd_ch,port: byte; path: string): boolean;
function is_mycall(snd_ch,port: byte; path: string): boolean;
function is_correct_path(path: string; pid: byte): boolean;
function direct_addr(path: string): string;
function reverse_addr(path: string): string;
function reverse_digi(path: string): string;
function number_digi(path: string): byte;
function info_pid(pid: byte): string;
function get_fcs(var data: string; len: word): word;
function set_addr(path: string; rpt,cr: boolean): string;
function set_ctrl(nr,ns,f_type,f_id: byte; pf: boolean): byte;
function make_frame(data,path: string; pid,nr,ns,f_type,f_id: byte; rpt,pf,cr: boolean): string;
function get_incoming_socket_by_call(src_call: string): integer;
function add_incoming_mycalls(socket: integer; src_call: string): boolean;
function in_list_incoming_mycall(path: string): boolean;
function get_UTC_time: string;
function parse_NETROM(data: string; f_id: byte): string;
function parse_IP(data: string): string;
function parse_ARP(data: string): string;
function add_raw_frames(snd_ch: byte; frame: string; var buf: TStringList): boolean;
function scrambler(in_buf: string): string;
function my_indexof(var l: TStringList; s: string): integer;
const
port_num=32;
PKT_ERR=17; //Minimum packet size, bytes
I_MAX=7; //Maximum number of packets
B_IDX_MAX=256;
ADDR_MAX_LEN=10;
FRAME_FLAG=126;
// Status flags
STAT_NO_LINK=0;
STAT_LINK=1;
STAT_CHK_LINK=2;
STAT_WAIT_ANS=3;
STAT_TRY_LINK=4;
STAT_TRY_UNLINK=5;
// <20>md,Resp,Poll,Final,Digipeater flags
SET_P=TRUE;
SET_F=FALSE;
SET_C=TRUE;
SET_R=FALSE;
SET_NO_RPT=FALSE;
SET_RPT=TRUE;
// Frame ID flags
I_FRM=0;
S_FRM=1;
U_FRM=2;
I_I=0;
S_RR=1;
S_RNR=5;
S_REJ=9;
U_SABM=47;
U_DISC=67;
U_DM=15;
U_UA=99;
U_FRMR=135;
U_UI=3;
// PID flags
PID_X25=$01; // 00000001-CCIT X25 PLP
PID_SEGMENT=$08; // 00001000-Segmentation fragment
PID_TEXNET=$C3; // 11000011-TEXNET Datagram Protocol
PID_LQ=$C4; // 11001000-Link Quality Protocol
PID_APPLETALK=$CA; // 11001010-Appletalk
PID_APPLEARP=$CB; // 11001011-Appletalk ARP
PID_IP=$CC; // 11001100-ARPA Internet Protocol
PID_ARP=$CD; // 11001101-ARPA Address Resolution Protocol
PID_NET_ROM=$CF; // 11001111-NET/ROM
*/
#define ADDR_MAX_LEN 10
#define PID_NO_L3 0xF0; // 11110000-No Level 3 Protocol
unsigned short CRCTable[256] = {
0, 4489, 8978, 12955, 17956, 22445, 25910, 29887,
35912, 40385, 44890, 48851, 51820, 56293, 59774, 63735,
4225, 264, 13203, 8730, 22181, 18220, 30135, 25662,
40137, 36160, 49115, 44626, 56045, 52068, 63999, 59510,
8450, 12427, 528, 5017, 26406, 30383, 17460, 21949,
44362, 48323, 36440, 40913, 60270, 64231, 51324, 55797,
12675, 8202, 4753, 792, 30631, 26158, 21685, 17724,
48587, 44098, 40665, 36688, 64495, 60006, 55549, 51572,
16900, 21389, 24854, 28831, 1056, 5545, 10034, 14011,
52812, 57285, 60766, 64727, 34920, 39393, 43898, 47859,
21125, 17164, 29079, 24606, 5281, 1320, 14259, 9786,
57037, 53060, 64991, 60502, 39145, 35168, 48123, 43634,
25350, 29327, 16404, 20893, 9506, 13483, 1584, 6073,
61262, 65223, 52316, 56789, 43370, 47331, 35448, 39921,
29575, 25102, 20629, 16668, 13731, 9258, 5809, 1848,
65487, 60998, 56541, 52564, 47595, 43106, 39673, 35696,
33800, 38273, 42778, 46739, 49708, 54181, 57662, 61623,
2112, 6601, 11090, 15067, 20068, 24557, 28022, 31999,
38025, 34048, 47003, 42514, 53933, 49956, 61887, 57398,
6337, 2376, 15315, 10842, 24293, 20332, 32247, 27774,
42250, 46211, 34328, 38801, 58158, 62119, 49212, 53685,
10562, 14539, 2640, 7129, 28518, 32495, 19572, 24061,
46475, 41986, 38553, 34576, 62383, 57894, 53437, 49460,
14787, 10314, 6865, 2904, 32743, 28270, 23797, 19836,
50700, 55173, 58654, 62615, 32808, 37281, 41786, 45747,
19012, 23501, 26966, 30943, 3168, 7657, 12146, 16123,
54925, 50948, 62879, 58390, 37033, 33056, 46011, 41522,
23237, 19276, 31191, 26718, 7393, 3432, 16371, 11898,
59150, 63111, 50204, 54677, 41258, 45219, 33336, 37809,
27462, 31439, 18516, 23005, 11618, 15595, 3696, 8185,
63375, 58886, 54429, 50452, 45483, 40994, 37561, 33584,
31687, 27214, 22741, 18780, 15843, 11370, 7921, 3960 };
unsigned short pkt_raw_min_len = 8;
int stat_r_mem = 0;
struct TKISSMode_t KISS;
TAX25Port AX25Port[4][port_num];
TStringList KISS_acked[4];
TStringList KISS_iacked[4];
typedef struct registeredCalls_t
{
UCHAR myCall[7]; // call in ax.25
void * socket;
} registeredCalls;
TStringList list_incoming_mycalls; // list strings containing a registered call
boolean busy = 0;
boolean dcd[5] = { 0 ,0 ,0, 0 };
boolean tx = 0;
int stdtones = 0;
int fullduplex = 0;
UCHAR diddles = 0;
word MEMRecovery[5] = { 200,200,200,200 };
int NonAX25[5] = { 0 };
boolean dyn_frack[4] = { FALSE,FALSE,FALSE,FALSE };
Byte recovery[4] = { 0,0,0,0 };
Byte users[4] = { 0,0,0,0 };
short txtail[5] = { 50, 50, 50, 50, 50 };
short txdelay[5] = { 400, 400, 400, 400, 400 };
short modem_def[5] = { 1, 1, 1, 1, 1 };
int emph_db[5] = { 0, 0, 0, 0, 0 };
UCHAR emph_all[5] = { 0, 0, 0, 0, 0 };
boolean KISS_opt[4] = { FALSE, FALSE, FALSE, FALSE };
int resptime[4] = { 1500,1500,1500,1500 };
int slottime[4] = { 100,100,100,100 };
int persist[4] = { 100,100,100,100 };
int kisspaclen[4] = { 128,128,128,128 };
int fracks[4] = { 10,10,10,10 };
int frack_time[4] = { 5,5,5,5 };
int idletime[4] = { 180,180,180,180 };
int redtime[4] = { 0,0,0,0 };
int IPOLL[4] = { 30,30,30,30 };
int maxframe[4] = { 4,4,4,4 };
int TXFrmMode[4] = { 1,1,1,1 };
int max_frame_collector[4] = { 6,6,6,6 };
char MyDigiCall[4][512] = { "","","","" };
char exclude_callsigns[4][512] = { "","","","" };
char exclude_APRS_frm[4][512] = { "","","","" };
TStringList list_exclude_callsigns[4];
TStringList list_exclude_APRS_frm[4];
TStringList list_digi_callsigns[4];
Byte xData[256];
Byte xEncoded[256];
Byte xDecoded[256];
int frame_count = 0;
int single_frame_count = 0;
/*
mydigi: string;
//// end of user params
addr: string[70];
ctrl: byte;
pid: byte=PID_NO_L3;
fcs: word;
data: string;
frame: string;
implementation
uses ax25_l2,sm_main;
*/
char * strlop(char * buf, char delim)
{
// Terminate buf at delim, and return rest of string
char * ptr = strchr(buf, delim);
if (ptr == NULL) return NULL;
*(ptr)++ = 0;
return ptr;
}
void Debugprintf(const char * format, ...)
{
char Mess[10000];
va_list(arglist);
va_start(arglist, format);
vsprintf(Mess, format, arglist);
WriteDebugLog(Mess);
return;
}
void AX25_conn(TAX25Port * AX25Sess, int snd_ch, Byte mode)
{
UNUSED(snd_ch);
char Msg[128];
int Len = 0;
switch (mode)
{
case MODE_OTHER:
Len = sprintf(Msg, "Incomming Connection from %s\r", AX25Sess->corrcall);
break;
case MODE_OUR:
Len = sprintf(Msg, "Connected To %s\r", AX25Sess->corrcall);
break;
};
SendtoTerm(AX25Sess->Sess, Msg, Len);
SetSessLabel(AX25Sess->Sess, AX25Sess->corrcall);
setMenus(1);
}
void send_data_buf(TAX25Port * AX25Sess, int nr);
void SendtoAX25(void * conn, Byte * Msg, int Len)
{
TAX25Port * AX25Sess;
AX25Sess = (TAX25Port * )conn;
// Need to enforce PacLen
if (AX25Sess)
{
int n;
while (Len)
{
string * data = newString();
if (Len > kisspaclen[0])
n = kisspaclen[0];
else
n = Len;
stringAdd(data, Msg, n);
Add(&AX25Sess->in_data_buf, data);
Len -= n;
Msg += n;
}
send_data_buf(AX25Sess, AX25Sess->vs);
}
}
void scrambler(UCHAR * in_buf, int Len)
{
integer i;
word sreg;
Byte a = 0, k;
sreg = 0x1ff;
for (i = 0; i < Len; i++)
{
for (k = 0; k < 8; k++)
{
// a: = (a shr 1) or (sreg and 1 shl 7);
a = (a >> 1) | ((sreg & 1) << 7);
// sreg: = (sreg shl 4 and $200) xor (sreg shl 8 and $200) or (sreg shr 1);
sreg = (((sreg << 4) & 0x200) ^ ((sreg << 8) & 0x200)) | (sreg >> 1);
}
in_buf[i] = in_buf[i] ^ a;
}
}
/*
function parse_ARP(data: string): string;
function get_callsign(data: string): string;
var
i: integer;
s: string;
a: byte;
begin
s:='';
if length(data)=7 then
begin
for i:=1 to 6 do
begin
a:=ord(data[i]) shr 1;
if (a in [$30..$39,$41..$5A]) then s:=s+chr(a);
end;
a:=ord(data[7]) shr 1 and 15;
if a>0 then s:=s+'-'+inttostr(a);
end
else
begin
if length(data)>0 then
begin
for i:=1 to length(data) do
if i=1 then s:=dec2hex(ord(data[i])) else s:=s+':'+dec2hex(ord(data[i]));
end;
end;
if s<>'' then s:=s+' ';
result:=s;
end;
function get_IP(data: string): string;
var
i: integer;
s: string;
begin
s:='';
if length(data)>0 then
begin
for i:=1 to length(data) do
if i=1 then s:=inttostr(ord(data[i])) else s:=s+'.'+inttostr(ord(data[i]));
end;
if s<>'' then s:=s+' ';
result:=s;
end;
const
opcode: array [0..3] of string = ('ARP Request','ARP Response','RARP Request','RARP Response');
var
oper: word;
hlen,plen: byte;
sha,spa,tha,tpa: string;
s: string;
i: word;
begin
s:=data;
if length(data)>7 then
begin
hlen:=ord(data[5]);
plen:=ord(data[6]);
oper:=(ord(data[7]) shl 8 or ord(data[8])) and 2;
i:=9; sha:=get_callsign(copy(data,i,hlen));
i:=i+hlen; spa:=get_ip(copy(data,i,plen));
i:=i+plen; tha:=get_callsign(copy(data,i,hlen));
i:=i+hlen; tpa:=get_ip(copy(data,i,plen));
s:=' [ARP] '+opcode[oper]+' from '+sha+spa+'to '+tha+tpa;
end;
result:=s;
end;
function parse_NETROM(data: string; f_id: byte): string;
function deshift_AX25(data: string): string;
var
i: byte;
call: string[6];
ssid: string[2];
begin
result:='';
if length(data)<7 then exit;
for i:=1 to 7 do data[i]:=chr(ord(data[i]) shr 1);
call:=trim(copy(data,1,6));
ssid:=trim(inttostr(ord(data[7]) and 15));
if ssid='0' then result:=call else result:=call+'-'+ssid;
end;
function con_req_info(data: string): string;
var
s_call: string;
d_call: string;
w: byte;
t_o: byte;
begin
result:='';
if length(data)>14 then
begin
w:=ord(data[1]);
s_call:=deshift_AX25(copy(data,2,7));
d_call:=deshift_AX25(copy(data,9,7));
result:=' w='+inttostr(w)+' '+s_call+' at '+d_call;
end;
if length(data)>15 then
begin
t_o:=ord(data[16]);
result:=result+' t/o '+inttostr(t_o);
end;
end;
function con_ack_info(data: string): string;
var
w: byte;
begin
result:='';
if length(data)>0 then
begin
w:=ord(data[1]);
result:=' w='+inttostr(w);
end;
end;
const
opcode_arr: array[0..7] of string = ('PE','CON REQ','CON ACK','DISC REQ','DISQ ACK','INFO','INFO ACK','RST');
var
s: string;
netrom_header: string;
c_idx: byte;
c_ID: byte;
TX_nr: byte;
RX_nr: byte;
opcode: byte;
s_call: string;
s_node: string;
d_call: string;
d_node: string;
b_call: string;
r_s_nr: string;
opc_flags: string;
quality: byte;
ttl: byte;
hops: byte;
rtt: word;
inp3_nr_field: byte;
inp3_field_len: byte;
inp3_ext_fields: boolean;
begin
s:=data;
if length(data)>0 then
begin
if data[1]=#$FF then
begin
delete(data,1,1);
//Nodes broadcasting
if (f_id=U_UI) and (length(data)>5) then
begin
s_node:=copy(data,1,6);
delete(data,1,6);
s:='NODES broadcast from '+s_node+#13#10;
while length(data)>20 do
begin
d_call:=deshift_AX25(copy(data,1,7));
d_node:=copy(data,8,6);
b_call:=deshift_AX25(copy(data,14,7));
quality:=ord(data[21]);
delete(data,1,21);
s:=s+' '+d_node+':'+d_call+' via '+b_call+' Q='+inttostr(quality)+#13#10;
end;
end;
// INP3 RIF
if (f_id=I_I) and (length(data)>10) then
begin
s:='[INP3 RIF]'+#13#10;
while length(data)>10 do
begin
d_call:=deshift_AX25(copy(data,1,7));
hops:=ord(data[8]);
rtt:=(ord(data[9]) shl 8) or ord(data[10]);
delete(data,1,10);
inp3_ext_fields:=TRUE;
inp3_nr_field:=0;
while (length(data)>0) and inp3_ext_fields do
begin
inp3_field_len:=ord(data[1]);
if inp3_field_len>0 then
begin
if (inp3_nr_field=0) and (length(data)>1) then
begin
if data[2]=#0 then d_call:=copy(data,3,inp3_field_len-2)+':'+d_call; // Copy alias
end;
delete(data,1,inp3_field_len);
inc(inp3_nr_field);
end
else inp3_ext_fields:=FALSE;
end;
delete(data,1,1);
s:=s+d_call+' hops='+inttostr(hops)+' rtt='+inttostr(rtt)+#13#10;
end;
end;
end
else
begin
// NETROM frames
if length(data)>19 then
begin
s_call:=deshift_AX25(copy(data,1,7));
d_call:=deshift_AX25(copy(data,8,7));
ttl:=ord(data[15]);
netrom_header:=copy(data,16,5);
delete(data,1,20);
c_idx:=ord(netrom_header[1]);
c_ID:=ord(netrom_header[2]);
TX_nr:=ord(netrom_header[3]);
RX_nr:=ord(netrom_header[4]);
opcode:=ord(netrom_header[5]);
// Opcode flags
opc_flags:='';
if opcode and 128 = 128 then opc_flags:=opc_flags+' C';
if opcode and 64 = 64 then opc_flags:=opc_flags+' N';
//
s:=' [NETROM] '+s_call+' to '+d_call+' ttl='+inttostr(ttl)+' cct='+dec2hex(c_idx)+dec2hex(c_ID);
r_s_nr:=' S'+inttostr(TX_nr)+' R'+inttostr(RX_nr);
case (opcode and 7) of
0 : s:=s+' <'+opcode_arr[opcode and 7]+r_s_nr+'>'+#13#10+data;
1 : s:=s+' <'+opcode_arr[opcode and 7]+'>'+con_req_info(data);
2 : s:=s+' <'+opcode_arr[opcode and 7]+'>'+con_ack_info(data)+' my cct='+dec2hex(TX_nr)+dec2hex(RX_nr);
3 : s:=s+' <'+opcode_arr[opcode and 7]+'>';
4 : s:=s+' <'+opcode_arr[opcode and 7]+'>';
5 : s:=s+' <'+opcode_arr[opcode and 7]+r_s_nr+'>:'+#13#10+data;
6 : s:=s+' <'+opcode_arr[opcode and 7]+' R'+inttostr(RX_nr)+'>'+opc_flags;
7 : s:=s+' <'+opcode_arr[opcode and 7]+r_s_nr+'>'+#13#10+data;
end;
end;
end;
end;
result:=s;
end;
function parse_IP(data: string): string;
function parse_ICMP(var data: string): string;
var
ICMP_type: byte;
ICMP_code: byte;
s: string;
begin
result:='';
if length(data)>3 then
begin
ICMP_type:=ord(data[1]);
ICMP_code:=ord(data[2]);
delete(data,1,4);
s:=' [ICMP] Type='+inttostr(ICMP_type)+' Code='+inttostr(ICMP_code)+#13#10;
result:=s;
end;
end;
function parse_TCP(var data: string): string;
var
s: string;
src_port: string;
dest_port: string;
wnd: string;
ihl: word;
idl: word;
flags: byte;
seq: string;
ack: string;
s_flags: string;
s_idl: string;
begin
result:='';
if length(data)>19 then
begin
src_port:=' src_port:'+inttostr((ord(data[1]) shl 8)+ord(data[2]));
dest_port:=' dest_port:'+inttostr((ord(data[3]) shl 8)+ord(data[4]));
seq:=' seq='+dec2hex(ord(data[5]))+dec2hex(ord(data[6]))+dec2hex(ord(data[7]))+dec2hex(ord(data[8]));
ack:=' ack='+dec2hex(ord(data[9]))+dec2hex(ord(data[10]))+dec2hex(ord(data[11]))+dec2hex(ord(data[12]));
ihl:=(ord(data[13]) shr 4)*4;
idl:=length(data)-ihl;
flags:=ord(data[14]);
wnd:=' wnd='+inttostr((ord(data[15]) shl 8)+ord(data[16]));
delete(data,1,ihl);
//
s_flags:=' ';
if (flags and 32)=32 then s_flags:=s_flags+'URG ';
if (flags and 16)=16 then s_flags:=s_flags+'ACK ';
if (flags and 8)=8 then s_flags:=s_flags+'PSH ';
if (flags and 4)=4 then s_flags:=s_flags+'RST ';
if (flags and 2)=2 then s_flags:=s_flags+'SYN ';
if (flags and 1)=1 then s_flags:=s_flags+'FIN ';
//
if idl>0 then s_idl:=' data='+inttostr(idl) else s_idl:='';
if (flags and 16)<>16 then ack:='';
//
s:=' [TCP]'+src_port+dest_port+seq+ack+wnd+s_idl+s_flags+#13#10;
result:=s;
end;
end;
function parse_UDP(var data: string): string;
var
s: string;
src_port: string;
dest_port: string;
idl: word;
len: word;
s_idl: string;
begin
result:='';
if length(data)>7 then
begin
src_port:=' src_port:'+inttostr((ord(data[1]) shl 8)+ord(data[2]));
dest_port:=' dest_port:'+inttostr((ord(data[3]) shl 8)+ord(data[4]));
len:=(ord(data[5]) shl 8)+ord(data[6]);
idl:=len-8;
delete(data,1,8);
//
if idl>0 then s_idl:=' data='+inttostr(idl) else s_idl:='';
//
s:=' [UDP]'+src_port+dest_port+' len='+inttostr(len)+s_idl+#13#10;
result:=s;
end;
end;
const
prot_idx=#1#6#17;
prot_name: array [1..3] of string = ('ICMP','TCP','UDP');
var
s: string;
src_ip: string;
dest_ip: string;
s_prot: string;
len: string;
c_prot: char;
ttl: string;
offset: string;
ihl: byte;
p: byte;
fragment_offset: word;
begin
s:=data;
if length(data)>19 then
begin
ihl:=(ord(data[1]) and 15)*4;
len:=' len='+inttostr((ord(data[3]) shl 8)+ord(data[4]));
fragment_offset:=((ord(data[7]) shl 8)+ord(data[8])) shl 3;
ttl:=' ttl='+inttostr(ord(data[9]));
c_prot:=data[10];
src_ip:=' Fm '+inttostr(ord(data[13]))+'.'+inttostr(ord(data[14]))+'.'+inttostr(ord(data[15]))+'.'+inttostr(ord(data[16]));
dest_ip:=' To '+inttostr(ord(data[17]))+'.'+inttostr(ord(data[18]))+'.'+inttostr(ord(data[19]))+'.'+inttostr(ord(data[20]));
delete(data,1,ihl);
//
p:=pos(c_prot,prot_idx);
if p>0 then s_prot:=' prot='+prot_name[p] else s_prot:=' prot=Type'+inttostr(ord(c_prot));
if fragment_offset>0 then offset:=' offset='+inttostr(fragment_offset) else offset:='';
s:=' [IP]'+src_ip+dest_ip+s_prot+ttl+len+offset+#13#10;
if fragment_offset=0 then
case p of
1 : s:=s+parse_ICMP(data);
2 : s:=s+parse_TCP(data);
3 : s:=s+parse_UDP(data);
end;
s:=s+data;
end;
result:=s;
end;
function get_UTC_time: string;
var
st: TSYSTEMTIME;
sec,hour,minute: string;
begin
GetSystemTime(st);
if st.wSecond<10 then sec:='0'+inttostr(st.wSecond) else sec:=inttostr(st.wSecond);
if st.wMinute<10 then minute:='0'+inttostr(st.wMinute) else minute:=inttostr(st.wMinute);
if st.wHour<10 then Hour:='0'+inttostr(st.wHour) else Hour:=inttostr(st.wHour);
result:=hour+':'+minute+':'+sec;
end;
function dec2hex(value: byte): string;
const
hex='0123456789ABCDEF';
var
lo,hi: byte;
begin
lo:=value and 15;
hi:=value shr 4;
result:=hex[hi+1]+hex[lo+1];
end;
*/
unsigned short get_fcs(UCHAR * Data, unsigned short len)
{
unsigned short i;
unsigned short result;
result = 0xFFFF;
if (len == 0)
return result;
for (i = 0; i < len; i++)
result = (result >> 8) ^ CRCTable[(result ^ Data[i]) & 0xff];
result ^= 0xffff;
return result;
}
unsigned short CRCTAB[256] = {
0x0000, 0x1189, 0x2312, 0x329b, 0x4624, 0x57ad, 0x6536, 0x74bf,
0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, 0xdbe5, 0xe97e, 0xf8f7,
0x1081, 0x0108, 0x3393, 0x221a, 0x56a5, 0x472c, 0x75b7, 0x643e,
0x9cc9, 0x8d40, 0xbfdb, 0xae52, 0xdaed, 0xcb64, 0xf9ff, 0xe876,
0x2102, 0x308b, 0x0210, 0x1399, 0x6726, 0x76af, 0x4434, 0x55bd,
0xad4a, 0xbcc3, 0x8e58, 0x9fd1, 0xeb6e, 0xfae7, 0xc87c, 0xd9f5,
0x3183, 0x200a, 0x1291, 0x0318, 0x77a7, 0x662e, 0x54b5, 0x453c,
0xbdcb, 0xac42, 0x9ed9, 0x8f50, 0xfbef, 0xea66, 0xd8fd, 0xc974,
0x4204, 0x538d, 0x6116, 0x709f, 0x0420, 0x15a9, 0x2732, 0x36bb,
0xce4c, 0xdfc5, 0xed5e, 0xfcd7, 0x8868, 0x99e1, 0xab7a, 0xbaf3,
0x5285, 0x430c, 0x7197, 0x601e, 0x14a1, 0x0528, 0x37b3, 0x263a,
0xdecd, 0xcf44, 0xfddf, 0xec56, 0x98e9, 0x8960, 0xbbfb, 0xaa72,
0x6306, 0x728f, 0x4014, 0x519d, 0x2522, 0x34ab, 0x0630, 0x17b9,
0xef4e, 0xfec7, 0xcc5c, 0xddd5, 0xa96a, 0xb8e3, 0x8a78, 0x9bf1,
0x7387, 0x620e, 0x5095, 0x411c, 0x35a3, 0x242a, 0x16b1, 0x0738,
0xffcf, 0xee46, 0xdcdd, 0xcd54, 0xb9eb, 0xa862, 0x9af9, 0x8b70,
0x8408, 0x9581, 0xa71a, 0xb693, 0xc22c, 0xd3a5, 0xe13e, 0xf0b7,
0x0840, 0x19c9, 0x2b52, 0x3adb, 0x4e64, 0x5fed, 0x6d76, 0x7cff,
0x9489, 0x8500, 0xb79b, 0xa612, 0xd2ad, 0xc324, 0xf1bf, 0xe036,
0x18c1, 0x0948, 0x3bd3, 0x2a5a, 0x5ee5, 0x4f6c, 0x7df7, 0x6c7e,
0xa50a, 0xb483, 0x8618, 0x9791, 0xe32e, 0xf2a7, 0xc03c, 0xd1b5,
0x2942, 0x38cb, 0x0a50, 0x1bd9, 0x6f66, 0x7eef, 0x4c74, 0x5dfd,
0xb58b, 0xa402, 0x9699, 0x8710, 0xf3af, 0xe226, 0xd0bd, 0xc134,
0x39c3, 0x284a, 0x1ad1, 0x0b58, 0x7fe7, 0x6e6e, 0x5cf5, 0x4d7c,
0xc60c, 0xd785, 0xe51e, 0xf497, 0x8028, 0x91a1, 0xa33a, 0xb2b3,
0x4a44, 0x5bcd, 0x6956, 0x78df, 0x0c60, 0x1de9, 0x2f72, 0x3efb,
0xd68d, 0xc704, 0xf59f, 0xe416, 0x90a9, 0x8120, 0xb3bb, 0xa232,
0x5ac5, 0x4b4c, 0x79d7, 0x685e, 0x1ce1, 0x0d68, 0x3ff3, 0x2e7a,
0xe70e, 0xf687, 0xc41c, 0xd595, 0xa12a, 0xb0a3, 0x8238, 0x93b1,
0x6b46, 0x7acf, 0x4854, 0x59dd, 0x2d62, 0x3ceb, 0x0e70, 0x1ff9,
0xf78f, 0xe606, 0xd49d, 0xc514, 0xb1ab, 0xa022, 0x92b9, 0x8330,
0x7bc7, 0x6a4e, 0x58d5, 0x495c, 0x3de3, 0x2c6a, 0x1ef1, 0x0f78
};
unsigned short int compute_crc(unsigned char *buf, int len)
{
unsigned short fcs = 0xffff;
int i;
for (i = 0; i < len; i++)
fcs = (fcs >> 8) ^ CRCTAB[(fcs ^ buf[i]) & 0xff];
fcs ^= 0xffff;
return fcs;
}
int get_addr(char * Calls, UCHAR * AXCalls)
{
// CONVERT CALL + OPTIONAL DIGI STRING (Comma separated) TO AX25, RETURN
// CONVERTED STRING IN AXCALLS. Return FALSE if invalied
Byte * axptr = AXCalls;
char * ptr, *Context;
int n = 8; // Max digis
memset(AXCalls, 0, 70);
ptr = strtok_s(Calls, " ,", &Context);
if (ptr == NULL)
return FALSE;
// First field is Call
if (ConvToAX25(ptr, axptr) == 0)
return FALSE;
axptr += 7;
ptr = strtok_s(NULL, " ,", &Context);
if (ConvToAX25(ptr, axptr) == 0)
return FALSE;
axptr += 7;
ptr = strtok_s(NULL, " ,", &Context);
while (ptr && n--)
{
// NEXT FIELD = COULD BE CALLSIGN, VIA,
if (memcmp(ptr, "VIA", (int)strlen(ptr)) == 0)
{
} //skip via
else
{
// Convert next digi
if (ConvToAX25(ptr, axptr) == 0)
return FALSE;
axptr += 7;
}
ptr = strtok_s(NULL, " ,", &Context);
}
axptr[-1] |= 1; // Set end of address
return axptr - AXCalls;
}
Byte set_ctrl(Byte nr, Byte ns, Byte f_type, Byte f_id, boolean pf)
{
Byte pf_bit, ctrl;
ctrl = 0;
pf_bit = 0;
if (pf)
pf_bit = 16;
switch (f_type)
{
case I_FRM:
ctrl = (nr << 5) + pf_bit + (ns << 1);
break;
case S_FRM:
ctrl = (nr << 5) + pf_bit + f_id;
break;
case U_FRM:
ctrl = f_id + pf_bit;
}
return ctrl;
}
string * make_frame(string * data, Byte * axaddr, Byte pid, Byte nr, Byte ns, Byte f_type, Byte f_id, boolean rpr, boolean pf, boolean cr)
{
UNUSED(rpr);
Byte ctrl;
string * frame = newString();
int addrlen;
Byte addr[80];
frame->Data[0] = 0; // Lower software expects a kiss control byte here
frame->Length = 1;
ctrl = set_ctrl(nr, ns, f_type, f_id, pf);
addrlen = strlen((char *)axaddr);
memcpy(addr, axaddr, addrlen);
if (cr)
addr[6] |= 0x80; // Set Command Bit
else
addr[13] |= 0x80; // Set Response Bit
switch (f_type)
{
case I_FRM:
stringAdd(frame, addr, addrlen);
stringAdd(frame, (Byte *)&ctrl, 1);
stringAdd(frame, (Byte *)&pid, 1);
stringAdd(frame, data->Data, data->Length);
break;
case S_FRM:
stringAdd(frame, addr, addrlen);
stringAdd(frame, (Byte *)&ctrl, 1);
break;
case U_FRM:
if (f_id == U_UI)
{
stringAdd(frame, addr, addrlen);
stringAdd(frame, (Byte *)&ctrl, 1);
stringAdd(frame, (Byte *)&pid, 1);
stringAdd(frame, data->Data, data->Length);
}
else if (f_id == U_FRMR)
{
stringAdd(frame, addr, addrlen);
stringAdd(frame, (Byte *)&ctrl, 1);
stringAdd(frame, data->Data, data->Length);
}
else
{
stringAdd(frame, addr, addrlen);
stringAdd(frame, (Byte *)&ctrl, 1);
}
}
return frame;
}
int add_raw_frames(int snd_ch, string * frame, TStringList * buf)
{
UNUSED(snd_ch);
string *s_data = newString();
Byte s_pid, s_nr, s_ns, s_f_type, s_f_id;
Byte s_rpt, s_cr, s_pf;
string *d_data = newString();
Byte d_pid, d_nr, d_ns, d_f_type, d_f_id;
Byte d_rpt, d_cr, d_pf;
Byte d_path[80];
Byte s_path[80];
boolean found_I;
int i;
unsigned char * framecontents;
int Length;
boolean result = TRUE;
// Have to be careful as at this point frames have KISS Header and maybe trailer
if (buf->Count > 0)
{
// Check for duplicate. Ok to just compare as copy will have same header
if (my_indexof(buf, frame) >= 0)
{
// Debugprintf("KISSOptimise discarding duplicate frame");
return FALSE;
}
// Need to adjust for KISS bytes
// Normally one, but ackmode has 3 on front and sizeof(void *) on end
framecontents = frame->Data;
Length = frame->Length;
if ((framecontents[0] & 15) == 12) // Ackmode
{
framecontents += 3;
Length -= (3 + sizeof(void *));
}
else
{
framecontents++;
Length--;
}
decode_frame(framecontents, Length, s_path, s_data, &s_pid, &s_nr, &s_ns, &s_f_type, &s_f_id, &s_rpt, &s_pf, &s_cr);
found_I = FALSE;
// check for multiple RR (r)
if (s_f_id == S_FRM && s_cr == SET_R)
{
for (i = 0; i < buf->Count; i++)
{
framecontents = buf->Items[i]->Data;
Length = buf->Items[i]->Length;
if ((framecontents[0] & 15) == 12) // Ackmode
{
framecontents += 3;
Length -= (3 + sizeof(void *));
}
else
{
framecontents++;
Length--;
}
decode_frame(framecontents, Length, d_path, d_data, &d_pid, &d_nr, &d_ns, &d_f_type, &d_f_id, &d_rpt, &d_pf, &d_cr);
if (d_f_id == S_FRM && d_cr == SET_R && strcmp((char *)s_path, (char *)d_path) == 0)
{
Delete(buf, i);
Debugprintf("KISSOptimise discarding unneeded RR(R%d)", d_nr);
break;
}
}
}
// check for RR after I Frame
if (s_f_id == S_FRM && s_cr == SET_C)
{
for (i = 0; i < buf->Count; i++)
{
framecontents = buf->Items[i]->Data;
Length = buf->Items[i]->Length;
if ((framecontents[0] & 15) == 12) // Ackmode
{
framecontents += 3;
Length -= (3 + sizeof(void *));
}
else
{
framecontents++;
Length--;
}
decode_frame(framecontents, Length, d_path, d_data, &d_pid, &d_nr, &d_ns, &d_f_type, &d_f_id, &d_rpt, &d_pf, &d_cr);
if (d_f_id == I_FRM && strcmp((char *)s_path, (char *)d_path) == 0)
{
found_I = TRUE;
break;
}
}
if (found_I)
{
Debugprintf("KISSOptimise discarding unneeded RR(C %d) after I frame", s_nr);
result = FALSE;
}
}
// check on I
if (s_f_id == I_FRM)
{
for (i = 0; i < buf->Count; i++)
{
framecontents = buf->Items[i]->Data;
Length = buf->Items[i]->Length;
if ((framecontents[0] & 15) == 12) // Ackmode
{
framecontents += 3;
Length -= (3 + sizeof(void *));
}
else
{
framecontents++;
Length--;
}
decode_frame(framecontents, Length, d_path, d_data, &d_pid, &d_nr, &d_ns, &d_f_type, &d_f_id, &d_rpt, &d_pf, &d_cr);
if (strcmp((char *)s_path, (char *)d_path) == 0 && d_f_id == S_FRM && d_cr == SET_C)
{
Delete(buf, i);
Debugprintf("KISSOptimise discarding unneeded RR(C %d)", d_nr);
i--; // i was removed
}
}
}
}
freeString(d_data);
freeString(s_data);
return result;
}
//////////////////////// Register incoming callsign ////////////////////////////
// I think a call should only be registered on one socket (or we won't know where to send
// incoming calls
boolean add_incoming_mycalls(void * socket, char * src_call)
{
registeredCalls * reg = malloc(sizeof(struct registeredCalls_t));
int i = 0;
// Build a string containing Call and Socket
ConvToAX25(src_call, reg->myCall);
reg->socket = socket;
if (list_incoming_mycalls.Count > 0)
{
for (i = 0; i < list_incoming_mycalls.Count; i++)
{
registeredCalls * check = (registeredCalls *)list_incoming_mycalls.Items[i];
if (memcmp(check->myCall, reg->myCall, 7) == 0)
{
// Update socket
check->socket = socket;
return FALSE;
}
}
}
Add(&list_incoming_mycalls, (string *)reg);
return TRUE;
}
void del_incoming_mycalls(char * src_call)
{
int i = 0;
Byte axcall[7];
registeredCalls * reg;
ConvToAX25(src_call, axcall);
while (i < list_incoming_mycalls.Count)
{
reg = (registeredCalls *)list_incoming_mycalls.Items[i];
{
if (memcmp(reg->myCall, axcall, 7) == 0)
{
// cant use Delete as stringlist doesn't contain strings
TStringList * Q = &list_incoming_mycalls;
int Index = i;
free(Q->Items[Index]);
Q->Count--;
while (Index < Q->Count)
{
Q->Items[Index] = Q->Items[Index + 1];
Index++;
}
return;
}
}
i++;
}
}
void del_incoming_mycalls_by_sock(void * socket)
{
int i = 0, snd_ch, port;
registeredCalls * reg;
while (i < list_incoming_mycalls.Count)
{
reg = (registeredCalls *)list_incoming_mycalls.Items[i];
{
if (reg->socket == socket)
{
// cant use Delete as stringlist doesn't contain strings
TStringList * Q = &list_incoming_mycalls;
int Index = i;
free(Q->Items[Index]);
Q->Count--;
while (Index < Q->Count)
{
Q->Items[Index] = Q->Items[Index + 1];
Index++;
}
//Delete(&list_incoming_mycalls, i);
}
else
i++;
}
}
// Should clear all connections on socket
for (snd_ch = 0; snd_ch < 4; snd_ch++)
{
for (port = 0; port < port_num; port++)
{
TAX25Port * AX25Sess = &AX25Port[snd_ch][port];
if (AX25Sess->socket == socket)
{
if (AX25Sess->status != STAT_NO_LINK)
{
// Shouldn't we send DM? -0 try it
set_DM(snd_ch, AX25Sess->ReversePath);
rst_timer(AX25Sess);
rst_values(AX25Sess);
AX25Sess->status = STAT_NO_LINK;
}
AX25Sess->socket = 0;
}
}
}
}
/*
function get_incoming_socket_by_call(src_call: string): integer;
var
i: integer;
found: boolean;
socket: integer;
call,ssid: string;
a_call: array[0..1] of string;
begin
socket:=-1;
i:=0;
found:=FALSE;
try explode(a_call,'-',src_call,2); except end;
call:=trim(a_call[0]);
if a_call[1]<>'' then ssid:=a_call[1] else ssid:='0';
if list_incoming_mycalls.Count>0 then
repeat
if (call+'-'+ssid)=list_incoming_mycalls.Strings[i] then
begin socket:=strtoint(list_incoming_mycalls_sock.Strings[i]); found:=TRUE; end;
inc(i);
until found or (i=list_incoming_mycalls.Count);
result:=socket;
end;
*/
void * in_list_incoming_mycall(Byte * path)
{
// See if to call is in registered calls list
int i = 0;
registeredCalls * check; // list_incoming_mycalls contains registeredCalls, not Strings
while (i < list_incoming_mycalls.Count)
{
check = (registeredCalls *)list_incoming_mycalls.Items[i];
if (memcmp(check->myCall, path, 7) == 0)
return check->socket;
i++;
}
return NULL;
}
/*
////////////////////////////////////////////////////////////////////////////////
function is_corrcall(snd_ch,port: byte; path: string): boolean;
var
call,ssid: string;
begin
call:=trim(copy(path,8,6));
ssid:=copy(path,14,1);
if ssid<>'' then ssid:=inttostr((ord(ssid[1]) and 15)) else ssid:='0';
call:=call+'-'+ssid;
if call=AX25Sess->corrcall then result:=TRUE else result:=FALSE;
end;
function is_mycall(snd_ch,port: byte; path: string): boolean;
var
call,ssid: string;
begin
call:=trim(copy(path,1,6));
ssid:=copy(path,7,1);
if ssid<>'' then ssid:=inttostr((ord(ssid[1]) and 15)) else ssid:='0';
call:=call+'-'+ssid;
if call=AX25Sess->mycall then result:=TRUE else result:=FALSE;
end;
function is_digi(snd_ch,port: byte; path: string): boolean;
var
digi,call,ssid: string;
begin
digi:='';
if length(path)>14 then
begin
delete(path,1,14);
repeat
call:=trim(copy(path,1,6));
ssid:=copy(path,7,1);
delete(path,1,7);
if ssid<>'' then ssid:=inttostr((ord(ssid[1]) and 15))
else ssid:='0';
if path<>'' then digi:=digi+call+'-'+ssid+','
else digi:=digi+call+'-'+ssid;
until path='';
end;
if digi=AX25Sess->digi then result:=TRUE else result:=FALSE;
end;
*/
// Check if laast digi used
boolean is_last_digi(Byte *path)
{
int len = strlen(path);
if (len == 14)
return TRUE;
if ((path[len - 1] & 128) == 128)
return TRUE;
return FALSE;
}
/*
function get_corrcall(path: string): string;
var
call,ssid: string;
begin
call:=trim(copy(path,8,6));
ssid:=copy(path,14,1);
if ssid<>'' then ssid:=inttostr((ord(ssid[1]) and 15)) else ssid:='0';
call:=call+'-'+ssid;
result:=call;
end;
function get_mycall(path: string): string;
var
call,ssid: string;
begin
call:=trim(copy(path,1,6));
ssid:=copy(path,7,1);
if ssid<>'' then ssid:=inttostr((ord(ssid[1]) and 15)) else ssid:='0';
call:=call+'-'+ssid;
result:=call;
end;
function get_digi(path: string): string;
var
digi,call,ssid: string;
begin
digi:='';
if length(path)>14 then
begin
delete(path,1,14);
repeat
call:=trim(copy(path,1,6));
ssid:=copy(path,7,1);
delete(path,1,7);
if ssid<>'' then ssid:=inttostr((ord(ssid[1]) and 15))
else ssid:='0';
if path<>'' then digi:=digi+call+'-'+ssid+','
else digi:=digi+call+'-'+ssid;
until path='';
end;
result:=digi;
end;
*/
boolean is_correct_path(Byte * path, Byte pid)
{
Byte networks[] = { 6, 7, 8, 0xc4, 0xcc, 0xcd, 0xce, 0xcf, 0xf0 , 0 };
int i;
if (pid == 0 || strchr(networks, pid))
{
// Validate calls
// I think checking bottom bit of first 13 bytes is enough
for (i = 0; i < 13; i++)
{
if ((*(path) & 1))
return FALSE;
path++;
}
return TRUE;
}
return FALSE;
}
void get_exclude_list(char * line, TStringList * list)
{
// Convert comma separated list of calls to ax25 format in list
string axcall;
char copy[512];
char * ptr, *Context;
if (line[0] == 0)
return;
strcpy(copy, line); // copy as strtok messes with it
strcat(copy, ",");
axcall.Length = 8;
axcall.AllocatedLength = 8;
axcall.Data = malloc(8);
memset(axcall.Data, 0, 8);
ptr = strtok_s(copy, " ,", &Context);
while (ptr)
{
if (ConvToAX25(ptr, axcall.Data) == 0)
return;
Add(list, duplicateString(&axcall));
ptr = strtok_s(NULL, " ,", &Context);
}
}
void get_exclude_frm(char * line, TStringList * list)
{
UNUSED(line);
UNUSED(list);
/*
s: string;
p: integer;
n: integer;
begin
list.Clear;
if line='' then exit;
repeat
p:=pos(',',line);
if p>0 then
begin
s:=trim(copy(line,1,p-1));
if s<>'' then
begin
try n:=strtoint(s); except n:=-1; end;
if n in [0..255] then list.Add(chr(n));
end;
delete(line,1,p);
end
else
begin
s:=trim(line);
if s<>'' then
begin
try n:=strtoint(s); except n:=-1; end;
if n in [0..255] then list.Add(chr(n));
end;
end;
until p=0;
end;
*/
}
/*
function is_excluded_call(snd_ch: byte; path: string): boolean;
var
excluded: boolean;
call: string;
ssid: string;
begin
excluded:=FALSE;
if (list_exclude_callsigns[snd_ch].Count>0) and (length(path)>13) then
begin
// Copy sender
call:=trim(copy(path,8,6));
ssid:=copy(path,14,1);
if ssid<>'' then call:=call+'-'+inttostr((ord(ssid[1]) and 15));
if list_exclude_callsigns[snd_ch].IndexOf(call)>-1 then excluded:=TRUE;
end;
result:=excluded;
end;
function is_excluded_frm(snd_ch,f_id: byte; data: string): boolean;
var
excluded: boolean;
begin
excluded:=FALSE;
if list_exclude_APRS_frm[snd_ch].Count>0 then
if f_id=U_UI then
if length(data)>0 then
if list_exclude_APRS_frm[snd_ch].IndexOf(data[1])>=0 then excluded:=TRUE;
result:=excluded;
end;
procedure set_corrcall(snd_ch,port: byte; path: string);
var
call,ssid: string;
begin
call:=trim(copy(path,8,6));
ssid:=copy(path,14,1);
if ssid<>'' then ssid:=inttostr((ord(ssid[1]) and 15))
else ssid:='0';
AX25Sess->corrcall:=call+'-'+ssid;
end;
procedure set_mycall(snd_ch,port: byte; path: string);
var
call,ssid: string;
begin
call:=trim(copy(path,1,6));
ssid:=copy(path,7,1);
if ssid<>'' then ssid:=inttostr((ord(ssid[1]) and 15))
else ssid:='0';
AX25Sess->mycall:=call+'-'+ssid;
end;
procedure set_digi(snd_ch,port: byte; path: string);
var
digi,call,ssid: string;
begin
digi:='';
if length(path)>14 then
begin
delete(path,1,14);
repeat
call:=trim(copy(path,1,6));
ssid:=copy(path,7,1);
delete(path,1,7);
if ssid<>'' then ssid:=inttostr((ord(ssid[1]) and 15))
else ssid:='0';
if path<>'' then digi:=digi+call+'-'+ssid+','
else digi:=digi+call+'-'+ssid;
until path='';
end;
AX25Sess->digi:=digi;
end;
procedure get_call_fm_path(path: string; var callto,callfrom: string);
var
a_path: array [0..ADDR_MAX_LEN-1] of string;
i: byte;
begin
for i:=0 to ADDR_MAX_LEN-1 do a_path[i]:='';
try explode(a_path,',',path,ADDR_MAX_LEN); except end;
callto:=a_path[0];
callfrom:=a_path[1];
end;
procedure get_call(src_call: string; var call: string);
var
a_call: array[0..1] of string;
ssid: string;
begin
try explode(a_call,'-',src_call,2); except end;
call:=trim(a_call[0]);
if a_call[1]<>'' then ssid:=trim(a_call[1]) else ssid:='0';
call:=call+'-'+ssid;
end;
*/
int number_digi(unsigned char * path)
{
UNUSED(path);
int n = 0;
// a_path: array [0..ADDR_MAX_LEN-3] of string;
// for i:=0 to ADDR_MAX_LEN-3 do a_path[i]:='';
// try explode(a_path,',',path,ADDR_MAX_LEN-2); except end;
// for i:=0 to ADDR_MAX_LEN-3 do if a_path[i]<>'' then inc(n);
return n;
}
void get_monitor_path(Byte * path, char * mycall, char * corrcall, char * digi)
{
Byte * digiptr = digi;
digi[0] = 0;
mycall[ConvFromAX25(path, mycall)] = 0;
path += 7;
corrcall[ConvFromAX25(path, corrcall)] = 0;
while ((path[6] & 1) == 0) // End of call bit
{
if (digi != digiptr)
*(digi++) = ',';
path += 7;
digi += ConvFromAX25(path, digi);
if (((path[6] & 128) == 128)) // Digi'd
*(digi++) = '*';
}
*digi = 0;
}
/*
function reverse_digi(path: string): string;
var
digi: string;
a_path: array [0..ADDR_MAX_LEN-3] of string;
i: word;
begin
digi:='';
for i:=0 to ADDR_MAX_LEN-3 do a_path[i]:='';
try explode(a_path,',',path,ADDR_MAX_LEN-2); except end;
for i:=0 to ADDR_MAX_LEN-3 do
if a_path[i]<>'' then
begin
if digi='' then digi:=a_path[i]+digi
else digi:=a_path[i]+','+digi;
end;
result:=digi;
end;
function direct_addr(path: string): string;
var
s,call,ssid: string;
begin
s:='';
repeat
call:=copy(path,1,6);
delete(path,1,6);
ssid:=copy(path,1,1);
delete(path,1,1);
if ssid<>'' then ssid:=inttostr((ord(ssid[1]) and 15));
if s='' then s:=call+'-'+ssid else s:=s+','+call+'-'+ssid;
until path='';
result:=s;
end;
*/
void reverse_addr(Byte * path, Byte * revpath, int Len)
{
Byte * ptr = path;
Byte * copy = revpath;
int endbit = Len - 1;
int numdigis = (Len - 14) / 7;
int i;
if (Len < 14)
return;
Byte digis[57]; // 8 * 7 + null terminator
memset(digis, 0, 57);
Byte * digiptr = digis + 49; // Last Digi
// remove end of address bit
path[endbit] &= 0xFE;
// first reverse dest and origin
memcpy(copy + 7, ptr, 7);
memcpy(copy, ptr + 7, 7);
Len -= 14;
ptr += 14;
for (i = 0; i < numdigis; i++)
{
memcpy(digiptr, ptr, 7);
ptr += 7;
digiptr -= 7;
}
// Digiptr now points to new first digi
memcpy(&copy[14], &digiptr[7], 7 * numdigis);
path[endbit] |= 1; // restore original end bit
copy[endbit++] |= 1;
copy[endbit] = 0; // Null terminate
return;
}
void decode_frame(Byte * frame, int len, Byte * path, string * data,
Byte * pid, Byte * nr, Byte * ns, Byte * f_type, Byte * f_id,
Byte * rpt, Byte * pf, Byte * cr)
{
int i;
int addr_end;
Byte ctrl;
Byte * savepath = path;
i = 0;
addr_end = FALSE;
*cr = SET_R;
*pf = SET_F;
data->Length = 0;
ctrl = 0;
*pid = 0;
*nr = 0;
*ns = 0;
*f_type = 0;
*f_id = 0;
*rpt = FALSE;
if ((frame[6] & 128) == 128 && (frame[13] & 128) == 0)
*cr = SET_C;
while (len > i && i < ADDR_MAX_LEN * 7)
{
*path++ = frame[i];
if ((frame[i] & 1) == 1)
{
addr_end = TRUE;
break;
}
i++;
}
if (addr_end == 0)
return;
// clear the c and r bits from address
savepath[6] &= 0x7f; // Mask
savepath[13] &= 0x7f; // Mask
*path = 0; // add null terminate
i++; // Points to ctrl byte
ctrl = frame[i];
if ((ctrl & 16) == 16)
*pf = SET_P;
if ((ctrl & 1) == 0) // I frame
{
*f_type = I_FRM;
*f_id = I_I;
*nr = (ctrl >> 5);
*ns = (ctrl >> 1) & 7;
}
else
{
// Not I
*f_type = U_FRM;
*f_id = ctrl & 239;
switch (ctrl & 15)
{
case S_RR:
case S_RNR:
case S_REJ:
case S_SREJ:
*f_type = S_FRM;
}
if (*f_type == S_FRM)
{
*f_id = ctrl & 15;
*nr = ctrl >> 5;
}
}
if (*f_id == I_I || *f_id == U_UI)
{
i++;
*pid = frame[i];
i++;
if (len > i)
stringAdd(data, &frame[i], len - i);
}
else if (*f_id == U_FRMR)
{
*pid = 0;
i++;
if (len > i)
stringAdd(data, &frame[i], len - i);
}
}
void ax25_info_init(TAX25Port * AX25Sess)
{
AX25Sess->info.stat_s_pkt = 0;
AX25Sess->info.stat_s_byte = 0;
AX25Sess->info.stat_r_pkt = 0;
AX25Sess->info.stat_r_byte = 0;
AX25Sess->info.stat_r_fc = 0;
AX25Sess->info.stat_fec_count = 0;
AX25Sess->info.stat_l_r_byte = 0;
AX25Sess->info.stat_l_s_byte = 0;
AX25Sess->info.stat_begin_ses = 0;
AX25Sess->info.stat_end_ses = 0;
}
void clr_frm_win(TAX25Port * AX25Sess)
{
int i;
for (i = 0; i < 8; i++)
initString(&AX25Sess->frm_win[i]);
}
void ax25_init()
{
int snd_ch, port, i;
for (i = 0; i < 4; i++)
{
initTStringList(&list_exclude_callsigns[i]);
initTStringList(&list_exclude_APRS_frm[i]);
initTStringList(&list_digi_callsigns[i]);
initTStringList(&KISS_acked[i]);
get_exclude_list(MyDigiCall[i], &list_digi_callsigns[i]);
get_exclude_list(exclude_callsigns[i], &list_exclude_callsigns[i]);
get_exclude_frm(exclude_APRS_frm[i], &list_exclude_APRS_frm[i]);
}
initTStringList(&list_incoming_mycalls);
// initTStringList(&list_incoming_mycalls_sock);
for (snd_ch = 0; snd_ch < 4; snd_ch++)
{
for (port = 0; port < port_num; port++)
{
TAX25Port * AX25Sess = &AX25Port[snd_ch][port];
AX25Sess->hi_vs = 0;
AX25Sess->vs = 0;
AX25Sess->vr = 0;
AX25Sess->PID = PID_NO_L3;
initTStringList(&AX25Sess->in_data_buf);
initString(&AX25Sess->out_data_buf);
AX25Sess->t1 = 0;
AX25Sess->t2 = 0;
AX25Sess->t3 = 0;
AX25Sess->i_lo = 0;
AX25Sess->i_hi = 0;
AX25Sess->n1 = 0;
AX25Sess->n2 = 0;
AX25Sess->status = 0;
AX25Sess->clk_frack = 0;
initTStringList(&AX25Sess->frame_buf);
initTStringList(&AX25Sess->I_frame_buf);
initTStringList(&AX25Sess->frm_collector);
AX25Sess->corrcall[0] = 0;
AX25Sess->mycall[0] = 0;
AX25Sess->digi[0] = 0;
AX25Sess->Path[0] = 0;
AX25Sess->kind[0] = 0;
AX25Sess->socket = NULL;
ax25_info_init(AX25Sess);
clr_frm_win(AX25Sess);
}
}
}
/*
procedure ax25_free;
var
snd_ch,port,i: byte;
begin
for snd_ch:=1 to 4 do
for port:=0 to port_num-1 do
begin
AX25Sess->in_data_buf.Free;
AX25Sess->frame_buf.Free;
AX25Sess->I_frame_buf.Free;
AX25Sess->frm_collector.Free;
end;
for i:=1 to 4 do
begin
all_frame_buf[i].Free;
list_exclude_callsigns[i].Free;
list_exclude_APRS_frm[i].Free;
list_digi_callsigns[i].Free;
end;
list_incoming_mycalls.Free;
list_incoming_mycalls_sock.Free;
end;
*/
void write_ax25_info(TAX25Port * AX25Sess)
{
UNUSED(AX25Sess);
}
/*var
new: boolean;
t: text;
s: string;
time_ses: tdatetime;
time_ses_sec: extended;
call,mycall,spkt,sbyte,rpkt,rbyte,rfc,tcps,rcps,acps,startses,timeses: string;
begin
if stat_log then
begin
time_ses:=AX25Sess->info.stat_end_ses-AX25Sess->info.stat_begin_ses;
time_ses_sec:=time_ses*86400; //<2F><><EFBFBD><EFBFBD><EFBFBD> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <20> <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
if time_ses_sec<1 then exit;
mycall:=copy(AX25Sess->mycall+' ',1,9);
call:=copy(AX25Sess->corrcall+' ',1,9);
spkt:=copy(inttostr(AX25Sess->info.stat_s_pkt)+' ',1,6);
sbyte:=copy(inttostr(AX25Sess->info.stat_s_byte)+' ',1,9);
rpkt:=copy(inttostr(AX25Sess->info.stat_r_pkt)+' ',1,6);
rbyte:=copy(inttostr(AX25Sess->info.stat_r_byte)+' ',1,9);
rfc:=copy(inttostr(AX25Sess->info.stat_r_fc)+' ',1,6);
tcps:=copy(inttostr(round(AX25Sess->info.stat_s_byte/time_ses_sec))+' ',1,5);
rcps:=copy(inttostr(round(AX25Sess->info.stat_r_byte/time_ses_sec))+' ',1,5);
acps:=copy(inttostr(round(AX25Sess->info.stat_s_byte/time_ses_sec+AX25Sess->info.stat_r_byte/time_ses_sec))+' ',1,5);
timeses:=FormatDateTime('hh:mm:ss',time_ses);
startses:=FormatDateTime('dd-mm-yy hh:mm:ss',AX25Sess->info.stat_begin_ses);
s:=mycall+' '+call+' '+spkt+' '+sbyte+' '+rpkt+' '+rbyte+' '+rfc+' '+tcps+' '+rcps+' '+acps+' '+startses+' '+timeses;
assignfile(t,'log.txt');
if FileSearch('log.txt','')='' then new:=TRUE else new:=FALSE;
if new then
begin
rewrite(t);
writeln(t,'Mycall CorrCall TXPkt TXByte RXPkt RXByte FCPkt TXCPS RXCPS T.CPS Begin session SesTime');
writeln(t,'-------- --------- ------ --------- ------ --------- ------ ----- ----- ----- ----------------- --------');
end
else append(t);
if (AX25Sess->info.stat_s_byte>0) or (AX25Sess->info.stat_r_byte>0) then writeln(t,s);
closefile(t);
end;
end;
end.
*/
/*
Copyright 2001-2018 John Wiseman G8BPQ
This file is part of LinBPQ/BPQ32.
LinBPQ/BPQ32 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 3 of the License, or
(at your option) any later version.
LinBPQ/BPQ32 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 LinBPQ/BPQ32. If not, see http://www.gnu.org/licenses
*/
// Monitor Code - from moncode.asm
#define CMDBIT 4 // CURRENT MESSAGE IS A COMMAND
#define RESP 2 // CURRENT MSG IS RESPONSE
#define VER1 1 // CURRENT MSG IS VERSION 1
#define UI 3
#define SABM 0x2F
#define DISC 0x43
#define DM 0x0F
#define UA 0x63
#define FRMR 0x87
#define RR 1
#define RNR 5
#define REJ 9
#define PFBIT 0x10 // POLL/FINAL BIT IN CONTROL BYTE
#define NETROM_PID 0xCF
#define IP_PID 0xCC
#define ARP_PID 0xCD
#define NODES_SIG 0xFF
/*
DllExport int APIENTRY SetTraceOptions(int mask, int mtxparam, int mcomparam)
{
// Sets the tracing options for DecodeFrame. Mask is a bit
// mask of ports to monitor (ie 101 binary will monitor ports
// 1 and 3). MTX enables monitoring on transmitted frames. MCOM
// enables monitoring of protocol control frames (eg SABM, UA, RR),
// as well as info frames.
MMASK = mask;
MTX = mtxparam;
MCOM = mcomparam;
return (0);
}
DllExport int APIENTRY SetTraceOptionsEx(int mask, int mtxparam, int mcomparam, int monUIOnly)
{
// Sets the tracing options for DecodeFrame. Mask is a bit
// mask of ports to monitor (ie 101 binary will monitor ports
// 1 and 3). MTX enables monitoring on transmitted frames. MCOM
// enables monitoring of protocol control frames (eg SABM, UA, RR),
// as well as info frames.
MMASK = mask;
MTX = mtxparam;
MCOM = mcomparam;
MUIONLY = monUIOnly;
return 0;
}
*/
#define USHORT unsigned short
UCHAR MCOM = 1;
UCHAR MTX = 1;
ULONG MMASK = 0xF;
UCHAR MUIONLY = 0;
#define SREJ 0x0D
#define SABME 0x6F
#define XID 0xAF
#define TEST 0xE3
#define L4BUSY 0x80 // BNA - DONT SEND ANY MORE
#define L4NAK 0x40 // NEGATIVE RESPONSE FLAG
#define L4MORE 0x20 // MORE DATA FOLLOWS - FRAGMENTATION FLAG
#define L4CREQ 1 // CONNECT REQUEST
#define L4CACK 2 // CONNECT ACK
#define L4DREQ 3 // DISCONNECT REQUEST
#define L4DACK 4 // DISCONNECT ACK
#define L4INFO 5 // INFORMATION
#define L4IACK 6 // INFORMATION ACK
//#pragma pack(1)
#pragma pack(push, 1)
struct myin_addr {
union {
struct { unsigned char s_b1, s_b2, s_b3, s_b4; } S_un_b;
struct { unsigned short s_w1, s_w2; } S_un_w;
unsigned long addr;
};
};
typedef struct _IPMSG
{
// FORMAT OF IP HEADER
//
// NOTE THESE FIELDS ARE STORED HI ORDER BYTE FIRST (NOT NORMAL 8086 FORMAT)
UCHAR VERLEN; // 4 BITS VERSION, 4 BITS LENGTH
UCHAR TOS; // TYPE OF SERVICE
USHORT IPLENGTH; // DATAGRAM LENGTH
USHORT IPID; // IDENTIFICATION
USHORT FRAGWORD; // 3 BITS FLAGS, 13 BITS OFFSET
UCHAR IPTTL;
UCHAR IPPROTOCOL; // HIGHER LEVEL PROTOCOL
USHORT IPCHECKSUM; // HEADER CHECKSUM
struct myin_addr IPSOURCE;
struct myin_addr IPDEST;
UCHAR Data;
} IPMSG, *PIPMSG;
typedef struct _TCPMSG
{
// FORMAT OF TCP HEADER WITHIN AN IP DATAGRAM
// NOTE THESE FIELDS ARE STORED HI ORDER BYTE FIRST (NOT NORMAL 8086 FORMAT)
USHORT SOURCEPORT;
USHORT DESTPORT;
ULONG SEQNUM;
ULONG ACKNUM;
UCHAR TCPCONTROL; // 4 BITS DATA OFFSET 4 RESERVED
UCHAR TCPFLAGS; // (2 RESERVED) URG ACK PSH RST SYN FIN
USHORT WINDOW;
USHORT CHECKSUM;
USHORT URGPTR;
} TCPMSG, *PTCPMSG;
typedef struct _UDPMSG
{
// FORMAT OF UDP HEADER WITHIN AN IP DATAGRAM
// NOTE THESE FIELDS ARE STORED HI ORDER BYTE FIRST (NOT NORMAL 8086 FORMAT)
USHORT SOURCEPORT;
USHORT DESTPORT;
USHORT LENGTH;
USHORT CHECKSUM;
UCHAR UDPData[0];
} UDPMSG, *PUDPMSG;
// ICMP MESSAGE STRUCTURE
typedef struct _ICMPMSG
{
// FORMAT OF ICMP HEADER WITHIN AN IP DATAGRAM
// NOTE THESE FIELDS ARE STORED HI ORDER BYTE FIRST (NOT NORMAL 8086 FORMAT)
UCHAR ICMPTYPE;
UCHAR ICMPCODE;
USHORT ICMPCHECKSUM;
USHORT ICMPID;
USHORT ICMPSEQUENCE;
UCHAR ICMPData[0];
} ICMPMSG, *PICMPMSG;
typedef struct _L3MESSAGE
{
//
// NETROM LEVEL 3 MESSAGE - WITHOUT L2 INFO
//
UCHAR L3SRCE[7]; // ORIGIN NODE
UCHAR L3DEST[7]; // DEST NODE
UCHAR L3TTL; // TX MONITOR FIELD - TO PREVENT MESSAGE GOING // ROUND THE NETWORK FOR EVER DUE TO ROUTING LOOP
//
// NETROM LEVEL 4 DATA
//
UCHAR L4INDEX; // TRANSPORT SESSION INDEX
UCHAR L4ID; // TRANSPORT SESSION ID
UCHAR L4TXNO; // TRANSMIT SEQUENCE NUMBER
UCHAR L4RXNO; // RECEIVE (ACK) SEQ NUMBER
UCHAR L4FLAGS; // FRAGMENTATION, ACK/NAK, FLOW CONTROL AND MSG TYPE BITS
UCHAR L4DATA[236]; //DATA
} L3MESSAGE, *PL3MESSAGE;
typedef struct _MESSAGE
{
// BASIC LINK LEVEL MESSAGE BUFFER LAYOUT
struct _MESSAGE * CHAIN;
UCHAR PORT;
USHORT LENGTH;
UCHAR DEST[7];
UCHAR ORIGIN[7];
// MAY BE UP TO 56 BYTES OF DIGIS
UCHAR CTL;
UCHAR PID;
union
{ /* array named screen */
UCHAR L2DATA[256];
struct _L3MESSAGE L3MSG;
};
}MESSAGE, *PMESSAGE;
//#pragma pack()
#pragma pack(pop)
char * strlop(char * buf, char delim);
UCHAR * DisplayINP3RIF(UCHAR * ptr1, UCHAR * ptr2, unsigned int msglen);
char * DISPLAY_NETROM(MESSAGE * ADJBUFFER, UCHAR * Output, int MsgLen);
UCHAR * DISPLAYIPDATAGRAM(IPMSG * IP, UCHAR * Output, int MsgLen);
char * DISPLAYARPDATAGRAM(UCHAR * Datagram, UCHAR * Output);
int CountBits(unsigned long in)
{
int n = 0;
while (in)
{
if (in & 1) n++;
in >>= 1;
}
return n;
}
BOOL ConvToAX25(char * callsign, unsigned char * ax25call)
{
int i;
memset(ax25call, 0x40, 6); // in case short
ax25call[6] = 0x60; // default SSID
for (i = 0; i < 7; i++)
{
if (callsign[i] == '-')
{
//
// process ssid and return
//
i = atoi(&callsign[i + 1]);
if (i < 16)
{
ax25call[6] |= i << 1;
return (TRUE);
}
return (FALSE);
}
if (callsign[i] == 0 || callsign[i] == 13 || callsign[i] == ' ' || callsign[i] == ',')
{
//
// End of call - no ssid
//
return (TRUE);
}
ax25call[i] = callsign[i] << 1;
}
//
// Too many chars
//
return (FALSE);
}
int ConvFromAX25(unsigned char * incall, char * outcall)
{
int in, out = 0;
unsigned char chr;
memset(outcall, 0x20, 10);
for (in = 0; in < 6; in++)
{
chr = incall[in];
if (chr == 0x40)
break;
chr >>= 1;
outcall[out++] = chr;
}
chr = incall[6]; // ssid
if (chr == 0x42)
{
outcall[out++] = '-';
outcall[out++] = 'T';
return out;
}
if (chr == 0x44)
{
outcall[out++] = '-';
outcall[out++] = 'R';
return out;
}
chr >>= 1;
chr &= 15;
if (chr > 0)
{
outcall[out++] = '-';
if (chr > 9)
{
chr -= 10;
outcall[out++] = '1';
}
chr += 48;
outcall[out++] = chr;
}
return (out);
}
TKISSMode ** KissConnections = NULL;
int KISSConCount = 0;
#define FEND 0xc0
#define FESC 0xDB
#define TFEND 0xDC
#define TFESC 0xDD
#define KISS_ACKMODE 0x0C
#define KISS_DATA 0
int KISS_encode(UCHAR * KISSBuffer, int port, string * frame, int TXMON);
void KISS_init()
{
int i;
KISS.data_in = newString();
// initTStringList(KISS.socket);
for (i = 0; i < 4; i++)
{
initTStringList(&KISS.buffer[i]);
}
}
void ProcessKISSFrame(void * socket, UCHAR * Msg, int Len);
void KISSDataReceived(void * socket, unsigned char * data, int length)
{
int i;
unsigned char * ptr1, *ptr2;
int Length;
TKISSMode * KISS = NULL;
if (KISSConCount == 0)
return;
for (i = 0; i < KISSConCount; i++)
{
if (KissConnections[i]->Socket == socket)
{
KISS = KissConnections[i];
break;
}
}
if (KISS == NULL)
return;
stringAdd(KISS->data_in, data, length);
if (KISS->data_in->Length > 10000) // Probably AGW Data on KISS Port
{
KISS->data_in->Length = 0;
return;
}
ptr1 = KISS->data_in->Data;
Length = KISS->data_in->Length;
while ((ptr2 = memchr(ptr1, FEND, Length)))
{
int Len = (ptr2 - ptr1);
if (Len == 0)
{
// Start of frame
mydelete(KISS->data_in, 0, 1);
ptr1 = KISS->data_in->Data;
Length = KISS->data_in->Length;
continue;
}
// Process Frame
if (Len < 350) // Drop obviously corrupt frames
ProcessKISSFrame(socket, ptr1, Len);
mydelete(KISS->data_in, 0, Len + 1);
ptr1 = KISS->data_in->Data;
Length = KISS->data_in->Length;
}
}
void analiz_frame(int snd_ch, string * frame, void * socket, boolean fecflag);
void ProcessKISSFrame(void * socket, UCHAR * Msg, int Len)
{
int n = Len;
UCHAR c;
int ESCFLAG = 0;
UCHAR * ptr1, *ptr2;
int Chan;
int Opcode;
string * TXMSG;
unsigned short CRC;
UCHAR CRCString[2];
ptr1 = ptr2 = Msg;
while (n--)
{
c = *(ptr1++);
if (ESCFLAG)
{
//
// FESC received - next should be TFESC or TFEND
ESCFLAG = 0;
if (c == TFESC)
c = FESC;
if (c == TFEND)
c = FEND;
}
else
{
switch (c)
{
case FEND:
//
// Either start of message or message complete
//
// npKISSINFO->MSGREADY = TRUE;
return;
case FESC:
ESCFLAG = 1;
continue;
}
}
//
// Ok, a normal char
//
*(ptr2++) = c;
}
Len = ptr2 - Msg;
Chan = (Msg[0] >> 4);
Opcode = Msg[0] & 0x0f;
if (Chan > 3)
return;
switch (Opcode)
{
case KISS_ACKMODE:
// How best to do ACKMODE?? I think pass whole frame including CMD and ack bytes to all_frame_buf
// But ack should only be sent to client that sent the message - needs more thought!
TXMSG = newString();
stringAdd(TXMSG, &Msg[0], Len); // include Control
CRC = get_fcs(&Msg[3], Len - 3); // exclude control and ack bytes
CRCString[0] = CRC & 0xff;
CRCString[1] = CRC >> 8;
stringAdd(TXMSG, CRCString, 2);
// Ackmode needs to know where to send ack back to, so save socket on end of data
stringAdd(TXMSG, (unsigned char *)&socket, sizeof(socket));
// if KISS Optimise see if frame is really needed
if (!KISS_opt[Chan])
Add(&KISS.buffer[Chan], TXMSG);
else
{
if (add_raw_frames(Chan, TXMSG, &KISS.buffer[Chan]))
Add(&KISS.buffer[Chan], TXMSG);
}
return;
case KISS_DATA:
TXMSG = newString();
stringAdd(TXMSG, &Msg[1], Len - 1); // include Control
analiz_frame(Chan, TXMSG, socket, 0);
free(TXMSG);
return;
}
// Still need to process kiss control frames
}
void KISS_add_stream(void * Socket)
{
// Add a new connection. Called when QT accepts an incoming call}
TKISSMode * KISS;
KissConnections = realloc(KissConnections, (KISSConCount + 1) * sizeof(void *));
KISS = KissConnections[KISSConCount++] = malloc(sizeof(KISS));
KISS->Socket = Socket;
KISS->data_in = newString();
}
void KISS_del_socket(void * socket)
{
int i;
TKISSMode * KISS = NULL;
if (KISSConCount == 0)
return;
for (i = 0; i < KISSConCount; i++)
{
if (KissConnections[i]->Socket == socket)
{
KISS = KissConnections[i];
break;
}
}
if (KISS == NULL)
return;
// Need to remove entry and move others down
KISSConCount--;
while (i < KISSConCount)
{
KissConnections[i] = KissConnections[i + 1];
i++;
}
}
TAX25Port * get_free_port(int snd_ch);
TAX25Port * KISSConnectOut(void * Sess, char * CallFrom, char * CallTo, char * Digis, int Chan, void * Socket)
{
TAX25Port * AX25Sess = 0;
char path[128];
Byte axpath[80];
AX25Sess = get_free_port(Chan);
if (AX25Sess)
{
AX25Sess->snd_ch = Chan;
AX25Sess->Sess = Sess;
strcpy(AX25Sess->mycall, CallFrom);
strcpy(AX25Sess->corrcall, CallTo);
AX25Sess->PID = 0xf0;
sprintf(path, "%s,%s", CallTo, CallFrom);
if (Digis)
{
strcat(path, ",");
strcat(path, Digis);
}
AX25Sess->digi[0] = 0;
// rst_timer(snd_ch, free_port);
strcpy(AX25Sess->kind, "Outgoing");
AX25Sess->socket = Socket;
AX25Sess->pathLen = get_addr(path, axpath);
if (AX25Sess->pathLen == 0)
return AX25Sess; // Invalid Path
strcpy((char *)AX25Sess->Path, (char *)axpath);
reverse_addr(axpath, AX25Sess->ReversePath, AX25Sess->pathLen);
set_link(AX25Sess, AX25Sess->Path);
return AX25Sess;
}
return 0;
}
// Monitor Code - from moncode.asm
#define CMDBIT 4 // CURRENT MESSAGE IS A COMMAND
#define RESP 2 // CURRENT MSG IS RESPONSE
#define VER1 1 // CURRENT MSG IS VERSION 1
#define UI 3
#define SABM 0x2F
#define DISC 0x43
#define DM 0x0F
#define UA 0x63
#define FRMR 0x87
#define RR 1
#define RNR 5
#define REJ 9
#define SREJ 0x0D
#define SABME 0x6F
#define XID 0xAF
#define TEST 0xE3
#define PFBIT 0x10 // POLL/FINAL BIT IN CONTROL BYTE
#define NETROM_PID 0xCF
#define IP_PID 0xCC
#define ARP_PID 0xCD
#define NODES_SIG 0xFF
char ShortDT[] = "HH:MM:SS";
char * ShortDateTime()
{
struct tm * tm;
time_t NOW = time(NULL);
tm = gmtime(&NOW);
sprintf(ShortDT, "%02d:%02d:%02d", tm->tm_hour, tm->tm_min, tm->tm_sec);
return ShortDT;
}
char FrameData[1024] = "";
char * frame_monitor(string * frame, char * code, int tx_stat)
{
char mon_frm[512];
char Path[256];
char * frm = "???";
Byte * datap;
Byte _data[512] = "";
Byte * p_data = _data;
int _datalen;
;
char CallFrom[10], CallTo[10], Digi[80];
char TR = 'R';
char codestr[16] = "";
integer i;
int len;
Byte pid, nr, ns, f_type, f_id;
Byte rpt, cr, pf;
Byte path[80];
char c;
const char * p;
string * data = newString();
if (code[0] && strlen(code) < 14)
sprintf(codestr, "[%s]", code);
if (tx_stat)
TR = 'T';
if (tx_stat) // TX frame has control byte
decode_frame(frame->Data +1 , frame->Length - 1, path, data, &pid, &nr, &ns, &f_type, &f_id, &rpt, &pf, &cr);
else
decode_frame(frame->Data, frame->Length, path, data, &pid, &nr, &ns, &f_type, &f_id, &rpt, &pf, &cr);
datap = data->Data;
len = data->Length;
// if (pid == 0xCF)
// data = parse_NETROM(data, f_id);
// IP parsing
// else if (pid == 0xCC)
// data = parse_IP(data);
// ARP parsing
// else if (pid == 0xCD)
// data = parse_ARP(data);
//
if (len > 0)
{
for (i = 0; i < len; i++)
{
if (datap[i] > 31 || datap[i] == 13 || datap[i] == 9)
*(p_data++) = datap[i];
}
}
_datalen = p_data - _data;
if (_datalen)
{
Byte * ptr = _data;
i = 0;
// remove successive cr or cr on end while (i < _datalen)
while (i < _datalen)
{
if ((_data[i] == 13) && (_data[i + 1] == 13))
i++;
else
*(ptr++) = _data[i++];
}
if (*(ptr - 1) == 13)
ptr--;
*ptr = 0;
_datalen = ptr - _data;
}
get_monitor_path(path, CallTo, CallFrom, Digi);
if (cr)
{
c = 'C';
if (pf)
p = " P";
else p = "";
}
else
{
c = 'R';
if (pf)
p = " F";
else
p = "";
}
switch (f_id)
{
case I_I:
frm = "I";
break;
case S_RR:
frm = "RR";
break;
case S_RNR:
frm = "RNR";
break;
case S_REJ:
frm = "REJ";
break;
case S_SREJ:
frm = "SREJ";
break;
case U_SABM:
frm = "SABM";
break;
case SABME:
frm = "SABME";
break;
case U_DISC:
frm = "DISC";
break;
case U_DM:
frm = "DM";
break;
case U_UA:
frm = "UA";
break;
case U_FRMR:
frm = "FRMR";
break;
case U_UI:
frm = "UI";
}
// 07:29:42T G8BPQ - 2 > TEST Port = 20 < UI > :
// helllo
// 07:30: 8T G8BPQ - 2 > ID Port = 20 < UI C > :
// Network node(BPQ)
if (Digi[0])
// sprintf(Path, "Fm %s To %s Via %s <%s %c%s", CallFrom, CallTo, Digi, frm, c, p);
sprintf(Path, "%s%c %s>%s,%s <%s %c%s", ShortDateTime(), TR, CallFrom, CallTo, Digi, frm, c, p);
else
// sprintf(Path, "Fm %s To %s <%s %c %s", CallFrom, CallTo, frm, c, p);
sprintf(Path, "%s%c %s>%s <%s %c%s", ShortDateTime(), TR, CallFrom, CallTo, frm, c, p);
switch (f_type)
{
case I_FRM:
//mon_frm = Path + ctrl + ' R' + inttostr(nr) + ' S' + inttostr(ns) + ' pid=' + dec2hex(pid) + ' Len=' + inttostr(len) + ' >' + time_now + #13 + _data + #13#13;
sprintf(mon_frm, "%s R%d S%d>%s\r%s\r", Path, nr, ns, codestr, _data);
break;
case U_FRM:
if (f_id == U_UI)
{
sprintf(mon_frm, "%s>:\r%s\r", Path, _data); // "= Path + ctrl + '>' + time_now + #13;
}
else if (f_id == U_FRMR)
{
sprintf(mon_frm, "%s>%02x %02x %02x\r", Path, datap[0], datap[1], datap[2]); // "= Path + ctrl + '>' + time_now + #13;
}
else
sprintf(mon_frm, "%s>%s\r", Path, codestr); // "= Path + ctrl + '>' + time_now + #13;
break;
case S_FRM:
// mon_frm = Path + ctrl + ' R' + inttostr(nr) + ' >' + time_now + #13;
sprintf(mon_frm, "%s R%d>%s\r", Path, nr, codestr); // "= Path + ctrl + '>' + time_now + #13;
break;
}
sprintf(FrameData, "%s", mon_frm);
freeString(data);
return FrameData;
}