parent
dd4fb774e2
commit
90862645f6
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
@ -1,406 +1,383 @@
|
|||||||
|
|
||||||
/*
|
/*
|
||||||
* Copyright (C) 2010 by Scott Lawson KI4LKF
|
* Copyright (C) 2010 by Scott Lawson KI4LKF
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify
|
* 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
|
* it under the terms of the GNU General Public License as published by
|
||||||
* the Free Software Foundation; either version 2 of the License, or
|
* the Free Software Foundation; either version 2 of the License, or
|
||||||
* (at your option) any later version.
|
* (at your option) any later version.
|
||||||
*
|
*
|
||||||
* This program is distributed in the hope that it will be useful,
|
* This program is distributed in the hope that it will be useful,
|
||||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||||
* GNU General Public License for more details.
|
* GNU General Public License for more details.
|
||||||
*
|
*
|
||||||
* You should have received a copy of the GNU General Public License
|
* You should have received a copy of the GNU General Public License
|
||||||
* along with this program; if not, write to the Free Software
|
* along with this program; if not, write to the Free Software
|
||||||
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
/* by KI4LKF */
|
/* by KI4LKF */
|
||||||
|
|
||||||
#include <stdio.h>
|
#include <stdio.h>
|
||||||
#include <fcntl.h>
|
#include <fcntl.h>
|
||||||
#include <string.h>
|
#include <string.h>
|
||||||
#include <ctype.h>
|
#include <ctype.h>
|
||||||
#include <unistd.h>
|
#include <unistd.h>
|
||||||
#include <errno.h>
|
#include <errno.h>
|
||||||
#include <stdlib.h>
|
#include <stdlib.h>
|
||||||
#include <sys/stat.h>
|
#include <sys/stat.h>
|
||||||
#include <sys/types.h>
|
#include <sys/types.h>
|
||||||
|
|
||||||
#include <netinet/in.h>
|
#include <netinet/in.h>
|
||||||
#include <sys/socket.h>
|
#include <sys/socket.h>
|
||||||
#include <arpa/inet.h>
|
#include <arpa/inet.h>
|
||||||
#include <netdb.h>
|
#include <netdb.h>
|
||||||
#include <time.h>
|
#include <time.h>
|
||||||
|
|
||||||
#define VERSION "v3.2"
|
#define VERSION "v3.2"
|
||||||
|
|
||||||
static int sockDst = -1;
|
static int sockDst = -1;
|
||||||
static struct sockaddr_in toDst;
|
static struct sockaddr_in toDst;
|
||||||
static void dst_close();
|
static void dst_close();
|
||||||
static bool dst_open(char *ip, int port);
|
static bool dst_open(char *ip, int port);
|
||||||
static void calcPFCS(unsigned char rawbytes[58]);
|
static void calcPFCS(unsigned char rawbytes[58]);
|
||||||
|
|
||||||
static time_t tNow = 0;
|
static time_t tNow = 0;
|
||||||
static short streamid_raw = 0;
|
static short streamid_raw = 0;
|
||||||
|
|
||||||
/***
|
//static unsigned char silence[12] = { 0x4e,0x8d,0x32,0x88,0x26,0x1a,0x3f,0x61,0xe8,0x70,0x4f,0x93 };
|
||||||
static char silence[12] =
|
static unsigned char silence[12] = { 0xfa,0x87,0x1e,0x32,0x30,0x2f,0xea,0x45,0x66,0x70,0x4f,0x93 };
|
||||||
{
|
|
||||||
0x4e,0x8d,0x32,0x88,0x26,0x1a,0x3f,0x61,0xe8,
|
|
||||||
0x70,0x4f,0x93
|
static unsigned short crc_tabccitt[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,
|
||||||
static char silence[12] =
|
0x9cc9,0x8d40,0xbfdb,0xae52,0xdaed,0xcb64,0xf9ff,0xe876,
|
||||||
{
|
0x2102,0x308b,0x0210,0x1399,0x6726,0x76af,0x4434,0x55bd,
|
||||||
0xfa,0x87,0x1e,0x32,0x30,0x2f,0xea,0x45,0x66,
|
0xad4a,0xbcc3,0x8e58,0x9fd1,0xeb6e,0xfae7,0xc87c,0xd9f5,
|
||||||
0x70,0x4f,0x93
|
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,
|
||||||
static unsigned short crc_tabccitt[256] =
|
0x5285,0x430c,0x7197,0x601e,0x14a1,0x0528,0x37b3,0x263a,
|
||||||
{
|
0xdecd,0xcf44,0xfddf,0xec56,0x98e9,0x8960,0xbbfb,0xaa72,
|
||||||
0x0000,0x1189,0x2312,0x329b,0x4624,0x57ad,0x6536,0x74bf,
|
0x6306,0x728f,0x4014,0x519d,0x2522,0x34ab,0x0630,0x17b9,
|
||||||
0x8c48,0x9dc1,0xaf5a,0xbed3,0xca6c,0xdbe5,0xe97e,0xf8f7,
|
0xef4e,0xfec7,0xcc5c,0xddd5,0xa96a,0xb8e3,0x8a78,0x9bf1,
|
||||||
0x1081,0x0108,0x3393,0x221a,0x56a5,0x472c,0x75b7,0x643e,
|
0x7387,0x620e,0x5095,0x411c,0x35a3,0x242a,0x16b1,0x0738,
|
||||||
0x9cc9,0x8d40,0xbfdb,0xae52,0xdaed,0xcb64,0xf9ff,0xe876,
|
0xffcf,0xee46,0xdcdd,0xcd54,0xb9eb,0xa862,0x9af9,0x8b70,
|
||||||
0x2102,0x308b,0x0210,0x1399,0x6726,0x76af,0x4434,0x55bd,
|
0x8408,0x9581,0xa71a,0xb693,0xc22c,0xd3a5,0xe13e,0xf0b7,
|
||||||
0xad4a,0xbcc3,0x8e58,0x9fd1,0xeb6e,0xfae7,0xc87c,0xd9f5,
|
0x0840,0x19c9,0x2b52,0x3adb,0x4e64,0x5fed,0x6d76,0x7cff,
|
||||||
0x3183,0x200a,0x1291,0x0318,0x77a7,0x662e,0x54b5,0x453c,
|
0x9489,0x8500,0xb79b,0xa612,0xd2ad,0xc324,0xf1bf,0xe036,
|
||||||
0xbdcb,0xac42,0x9ed9,0x8f50,0xfbef,0xea66,0xd8fd,0xc974,
|
0x18c1,0x0948,0x3bd3,0x2a5a,0x5ee5,0x4f6c,0x7df7,0x6c7e,
|
||||||
0x4204,0x538d,0x6116,0x709f,0x0420,0x15a9,0x2732,0x36bb,
|
0xa50a,0xb483,0x8618,0x9791,0xe32e,0xf2a7,0xc03c,0xd1b5,
|
||||||
0xce4c,0xdfc5,0xed5e,0xfcd7,0x8868,0x99e1,0xab7a,0xbaf3,
|
0x2942,0x38cb,0x0a50,0x1bd9,0x6f66,0x7eef,0x4c74,0x5dfd,
|
||||||
0x5285,0x430c,0x7197,0x601e,0x14a1,0x0528,0x37b3,0x263a,
|
0xb58b,0xa402,0x9699,0x8710,0xf3af,0xe226,0xd0bd,0xc134,
|
||||||
0xdecd,0xcf44,0xfddf,0xec56,0x98e9,0x8960,0xbbfb,0xaa72,
|
0x39c3,0x284a,0x1ad1,0x0b58,0x7fe7,0x6e6e,0x5cf5,0x4d7c,
|
||||||
0x6306,0x728f,0x4014,0x519d,0x2522,0x34ab,0x0630,0x17b9,
|
0xc60c,0xd785,0xe51e,0xf497,0x8028,0x91a1,0xa33a,0xb2b3,
|
||||||
0xef4e,0xfec7,0xcc5c,0xddd5,0xa96a,0xb8e3,0x8a78,0x9bf1,
|
0x4a44,0x5bcd,0x6956,0x78df,0x0c60,0x1de9,0x2f72,0x3efb,
|
||||||
0x7387,0x620e,0x5095,0x411c,0x35a3,0x242a,0x16b1,0x0738,
|
0xd68d,0xc704,0xf59f,0xe416,0x90a9,0x8120,0xb3bb,0xa232,
|
||||||
0xffcf,0xee46,0xdcdd,0xcd54,0xb9eb,0xa862,0x9af9,0x8b70,
|
0x5ac5,0x4b4c,0x79d7,0x685e,0x1ce1,0x0d68,0x3ff3,0x2e7a,
|
||||||
0x8408,0x9581,0xa71a,0xb693,0xc22c,0xd3a5,0xe13e,0xf0b7,
|
0xe70e,0xf687,0xc41c,0xd595,0xa12a,0xb0a3,0x8238,0x93b1,
|
||||||
0x0840,0x19c9,0x2b52,0x3adb,0x4e64,0x5fed,0x6d76,0x7cff,
|
0x6b46,0x7acf,0x4854,0x59dd,0x2d62,0x3ceb,0x0e70,0x1ff9,
|
||||||
0x9489,0x8500,0xb79b,0xa612,0xd2ad,0xc324,0xf1bf,0xe036,
|
0xf78f,0xe606,0xd49d,0xc514,0xb1ab,0xa022,0x92b9,0x8330,
|
||||||
0x18c1,0x0948,0x3bd3,0x2a5a,0x5ee5,0x4f6c,0x7df7,0x6c7e,
|
0x7bc7,0x6a4e,0x58d5,0x495c,0x3de3,0x2c6a,0x1ef1,0x0f78
|
||||||
0xa50a,0xb483,0x8618,0x9791,0xe32e,0xf2a7,0xc03c,0xd1b5,
|
};
|
||||||
0x2942,0x38cb,0x0a50,0x1bd9,0x6f66,0x7eef,0x4c74,0x5dfd,
|
|
||||||
0xb58b,0xa402,0x9699,0x8710,0xf3af,0xe226,0xd0bd,0xc134,
|
static void calcPFCS(unsigned char rawbytes[58])
|
||||||
0x39c3,0x284a,0x1ad1,0x0b58,0x7fe7,0x6e6e,0x5cf5,0x4d7c,
|
{
|
||||||
0xc60c,0xd785,0xe51e,0xf497,0x8028,0x91a1,0xa33a,0xb2b3,
|
|
||||||
0x4a44,0x5bcd,0x6956,0x78df,0x0c60,0x1de9,0x2f72,0x3efb,
|
unsigned short crc_dstar_ffff = 0xffff;
|
||||||
0xd68d,0xc704,0xf59f,0xe416,0x90a9,0x8120,0xb3bb,0xa232,
|
unsigned short tmp, short_c;
|
||||||
0x5ac5,0x4b4c,0x79d7,0x685e,0x1ce1,0x0d68,0x3ff3,0x2e7a,
|
short int i;
|
||||||
0xe70e,0xf687,0xc41c,0xd595,0xa12a,0xb0a3,0x8238,0x93b1,
|
|
||||||
0x6b46,0x7acf,0x4854,0x59dd,0x2d62,0x3ceb,0x0e70,0x1ff9,
|
for (i = 17; i < 56 ; i++) {
|
||||||
0xf78f,0xe606,0xd49d,0xc514,0xb1ab,0xa022,0x92b9,0x8330,
|
short_c = 0x00ff & (unsigned short)rawbytes[i];
|
||||||
0x7bc7,0x6a4e,0x58d5,0x495c,0x3de3,0x2c6a,0x1ef1,0x0f78
|
tmp = (crc_dstar_ffff & 0x00ff) ^ short_c;
|
||||||
};
|
crc_dstar_ffff = (crc_dstar_ffff >> 8) ^ crc_tabccitt[tmp];
|
||||||
|
}
|
||||||
static void calcPFCS(unsigned char rawbytes[58])
|
crc_dstar_ffff = ~crc_dstar_ffff;
|
||||||
{
|
tmp = crc_dstar_ffff;
|
||||||
|
|
||||||
unsigned short crc_dstar_ffff = 0xffff;
|
rawbytes[56] = (unsigned char)(crc_dstar_ffff & 0xff);
|
||||||
unsigned short tmp, short_c;
|
rawbytes[57] = (unsigned char)((tmp >> 8) & 0xff);
|
||||||
short int i;
|
return;
|
||||||
|
}
|
||||||
for (i = 17; i < 56 ; i++)
|
|
||||||
{
|
static bool dst_open(char *ip, int port)
|
||||||
short_c = 0x00ff & (unsigned short)rawbytes[i];
|
{
|
||||||
tmp = (crc_dstar_ffff & 0x00ff) ^ short_c;
|
int reuse = 1;
|
||||||
crc_dstar_ffff = (crc_dstar_ffff >> 8) ^ crc_tabccitt[tmp];
|
|
||||||
}
|
sockDst = socket(PF_INET,SOCK_DGRAM,0);
|
||||||
crc_dstar_ffff = ~crc_dstar_ffff;
|
if (sockDst == -1) {
|
||||||
tmp = crc_dstar_ffff;
|
printf("Failed to create DSTAR socket\n");
|
||||||
|
return false;
|
||||||
rawbytes[56] = (unsigned char)(crc_dstar_ffff & 0xff);
|
}
|
||||||
rawbytes[57] = (unsigned char)((tmp >> 8) & 0xff);
|
if (setsockopt(sockDst,SOL_SOCKET,SO_REUSEADDR, (char *)&reuse, sizeof(reuse)) == -1) {
|
||||||
return;
|
close(sockDst);
|
||||||
}
|
sockDst = -1;
|
||||||
|
printf("setsockopt DSTAR REUSE failed\n");
|
||||||
static bool dst_open(char *ip, int port)
|
return false;
|
||||||
{
|
}
|
||||||
int reuse = 1;
|
memset(&toDst,0,sizeof(struct sockaddr_in));
|
||||||
|
toDst.sin_family = AF_INET;
|
||||||
sockDst = socket(PF_INET,SOCK_DGRAM,0);
|
toDst.sin_port = htons(port);
|
||||||
if (sockDst == -1)
|
toDst.sin_addr.s_addr = inet_addr(ip);
|
||||||
{
|
|
||||||
printf("Failed to create DSTAR socket\n");
|
fcntl(sockDst,F_SETFL,O_NONBLOCK);
|
||||||
return false;
|
return true;
|
||||||
}
|
}
|
||||||
if (setsockopt(sockDst,SOL_SOCKET,SO_REUSEADDR, (char *)&reuse, sizeof(reuse)) == -1)
|
|
||||||
{
|
static void dst_close()
|
||||||
close(sockDst); sockDst = -1;
|
{
|
||||||
printf("setsockopt DSTAR REUSE failed\n");
|
if (sockDst != -1) {
|
||||||
return false;
|
close(sockDst);
|
||||||
}
|
sockDst = -1;
|
||||||
memset(&toDst,0,sizeof(struct sockaddr_in));
|
}
|
||||||
toDst.sin_family = AF_INET;
|
return;
|
||||||
toDst.sin_port = htons(port);
|
}
|
||||||
toDst.sin_addr.s_addr = inet_addr(ip);
|
|
||||||
|
int main(int argc, char **argv)
|
||||||
fcntl(sockDst,F_SETFL,O_NONBLOCK);
|
{
|
||||||
return true;
|
unsigned char dstar_buf[58];
|
||||||
}
|
static unsigned short G2_COUNTER = 0;
|
||||||
|
unsigned long delay;
|
||||||
static void dst_close()
|
char RADIO_ID[21];
|
||||||
{
|
short int i;
|
||||||
if (sockDst != -1)
|
|
||||||
{
|
if (argc != 10) {
|
||||||
close(sockDst);
|
printf("Usage: g2link_test <IPaddress> <port> <textMessage> <repeaterCallsign> <module> <delay_between> <delay_before> <MYCALL> <YRCALL>\n");
|
||||||
sockDst = -1;
|
printf("Example: g2link_test 127.0.0.1 19000 \"HELLO\" KJ4NHF B 20 2 KI4LKF XRF005AL\n");
|
||||||
}
|
printf("Where...\n\n");
|
||||||
return;
|
printf(" 127.0.0.1 is the G2 INTERNAL IP of the G2 gateway\n");
|
||||||
}
|
printf(" 19000 is the the G2 INTERNAL port of the G2 gateway\n");
|
||||||
|
printf(" HELLO is the text message that we will send, no more than 20 characters\n");
|
||||||
int main(int argc, char **argv)
|
printf(" Note: the text message will be converted to UPPERCASE\n");
|
||||||
{
|
printf(" KJ4NHF is your dstar repeater callsign\n");
|
||||||
unsigned char dstar_buf[58];
|
printf(" B is the local repeater module\n");
|
||||||
static unsigned short G2_COUNTER = 0;
|
printf(" 20 millisecond delay before each packet is sent\n");
|
||||||
unsigned long delay;
|
printf(" 2 second delay before the program starts processing your input \n");
|
||||||
char RADIO_ID[21];
|
printf(" KI4LKF is the value of mycall\n");
|
||||||
short int i;
|
printf(" XRF005AL is the value of yrcall, in this case this is a Link command\n\n");
|
||||||
|
return 0;
|
||||||
if (argc != 10)
|
}
|
||||||
{
|
|
||||||
printf("Usage: g2link_test <IPaddress> <port> <textMessage> <repeaterCallsign> <module> <delay_between> <delay_before> <MYCALL> <YRCALL>\n");
|
if (strlen(argv[4]) > 6) {
|
||||||
printf("Example: g2link_test 127.0.0.1 19000 \"HELLO\" KJ4NHF B 20 2 KI4LKF XRF005AL\n");
|
printf("repeaterCallsign can not be more than 6 characters, %s is invalid\n", argv[4]);
|
||||||
printf("Where...\n\n");
|
return 0;
|
||||||
printf(" 127.0.0.1 is the G2 INTERNAL IP of the G2 gateway\n");
|
}
|
||||||
printf(" 19000 is the the G2 INTERNAL port of the G2 gateway\n");
|
for (i = 0; i < 6; i++)
|
||||||
printf(" HELLO is the text message that we will send, no more than 20 characters\n");
|
argv[4][i] = toupper(argv[4][i]);
|
||||||
printf(" Note: the text message will be converted to UPPERCASE\n");
|
|
||||||
printf(" KJ4NHF is your dstar repeater callsign\n");
|
|
||||||
printf(" B is the local repeater module\n");
|
if (strlen(argv[8]) > 8) {
|
||||||
printf(" 20 millisecond delay before each packet is sent\n");
|
printf("MYCALL can not be nore than 8 characters, %s is invalid\n", argv[8]);
|
||||||
printf(" 2 second delay before the program starts processing your input \n");
|
return 0;
|
||||||
printf(" KI4LKF is the value of mycall\n");
|
}
|
||||||
printf(" XRF005AL is the value of yrcall, in this case this is a Link command\n\n");
|
for (i = 0; i < 8; i++)
|
||||||
return 0;
|
argv[8][i] = toupper(argv[8][i]);
|
||||||
}
|
|
||||||
|
|
||||||
if (strlen(argv[4]) > 6)
|
if (strlen(argv[9]) > 8) {
|
||||||
{
|
printf("YRCALL can not be nore than 8 characters, %s is invalid\n", argv[9]);
|
||||||
printf("repeaterCallsign can not be more than 6 characters, %s is invalid\n", argv[4]);
|
return 0;
|
||||||
return 0;
|
}
|
||||||
}
|
for (i = 0; i < 8; i++)
|
||||||
for (i = 0; i < 6; i++)
|
argv[9][i] = toupper(argv[9][i]);
|
||||||
argv[4][i] = toupper(argv[4][i]);
|
|
||||||
|
if ((argv[5][0] != 'A') && (argv[5][0] != 'B') && (argv[5][0] != 'C')) {
|
||||||
|
printf("module must be one of A B C\n");
|
||||||
if (strlen(argv[8]) > 8)
|
return 0;
|
||||||
{
|
}
|
||||||
printf("MYCALL can not be nore than 8 characters, %s is invalid\n", argv[8]);
|
|
||||||
return 0;
|
delay = atol(argv[6]) * 1000L;
|
||||||
}
|
sleep(atoi(argv[7]));
|
||||||
for (i = 0; i < 8; i++)
|
|
||||||
argv[8][i] = toupper(argv[8][i]);
|
memset(RADIO_ID, ' ', 20);
|
||||||
|
RADIO_ID[20] = '\0';
|
||||||
|
memcpy(RADIO_ID, argv[3], (strlen(argv[3]) > 20)?20:strlen(argv[3]));
|
||||||
if (strlen(argv[9]) > 8)
|
|
||||||
{
|
/***
|
||||||
printf("YRCALL can not be nore than 8 characters, %s is invalid\n", argv[9]);
|
for (i = 0; i < 20; i++)
|
||||||
return 0;
|
RADIO_ID[i] = toupper(RADIO_ID[i]);
|
||||||
}
|
***/
|
||||||
for (i = 0; i < 8; i++)
|
|
||||||
argv[9][i] = toupper(argv[9][i]);
|
time(&tNow);
|
||||||
|
srand(tNow + getpid());
|
||||||
if ((argv[5][0] != 'A') && (argv[5][0] != 'B') && (argv[5][0] != 'C'))
|
|
||||||
{
|
if (dst_open(argv[1], atoi(argv[2]))) {
|
||||||
printf("module must be one of A B C\n");
|
streamid_raw = (short)(::rand() & 0xFFFF);
|
||||||
return 0;
|
memcpy(dstar_buf,"DSTR", 4);
|
||||||
}
|
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
||||||
|
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
||||||
delay = atol(argv[6]) * 1000L;
|
dstar_buf[6] = 0x73;
|
||||||
sleep(atoi(argv[7]));
|
dstar_buf[7] = 0x12;
|
||||||
|
dstar_buf[8] = 0x00;
|
||||||
memset(RADIO_ID, ' ', 20);
|
dstar_buf[9] = 0x30;
|
||||||
RADIO_ID[20] = '\0';
|
dstar_buf[10] = 0x20;
|
||||||
memcpy(RADIO_ID, argv[3], (strlen(argv[3]) > 20)?20:strlen(argv[3]));
|
|
||||||
|
dstar_buf[11] = 0x00;
|
||||||
/***
|
dstar_buf[12] = 0x01;
|
||||||
for (i = 0; i < 20; i++)
|
if (argv[5][0] == 'A')
|
||||||
RADIO_ID[i] = toupper(RADIO_ID[i]);
|
dstar_buf[13] = 0x03;
|
||||||
***/
|
else if (argv[5][0] == 'B')
|
||||||
|
dstar_buf[13] = 0x01;
|
||||||
time(&tNow);
|
else if (argv[5][0] == 'C')
|
||||||
srand(tNow + getpid());
|
dstar_buf[13] = 0x02;
|
||||||
|
else
|
||||||
if (dst_open(argv[1], atoi(argv[2])))
|
dstar_buf[13] = 0x00;
|
||||||
{
|
|
||||||
streamid_raw = (short)(::rand() & 0xFFFF);
|
dstar_buf[14] = (unsigned char)(streamid_raw & 0xFF);
|
||||||
memcpy(dstar_buf,"DSTR", 4);
|
dstar_buf[15] = (unsigned char)((streamid_raw >> 8) & 0xFF);
|
||||||
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
dstar_buf[16] = 0x80;
|
||||||
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
dstar_buf[17] = 0x00;
|
||||||
dstar_buf[6] = 0x73;
|
dstar_buf[18] = 0x00;
|
||||||
dstar_buf[7] = 0x12;
|
dstar_buf[19] = 0x00;
|
||||||
dstar_buf[8] = 0x00;
|
|
||||||
dstar_buf[9] = 0x30;
|
/* RPT2 */
|
||||||
dstar_buf[10] = 0x20;
|
memcpy(dstar_buf + 20, argv[4], strlen(argv[4]));
|
||||||
|
if (strlen(argv[4]) < 6)
|
||||||
dstar_buf[11] = 0x00;
|
memset(dstar_buf + 20 + strlen(argv[4]), ' ', 6 - strlen(argv[4]));
|
||||||
dstar_buf[12] = 0x01;
|
dstar_buf[26] = ' ';
|
||||||
if (argv[5][0] == 'A')
|
dstar_buf[27] = 'G';
|
||||||
dstar_buf[13] = 0x03;
|
|
||||||
else
|
/* RPT1 */
|
||||||
if (argv[5][0] == 'B')
|
memcpy(dstar_buf + 28, argv[4], strlen(argv[4]));
|
||||||
dstar_buf[13] = 0x01;
|
if (strlen(argv[4]) < 6)
|
||||||
else
|
memset(dstar_buf + 28 + strlen(argv[4]), ' ', 6 - strlen(argv[4]));
|
||||||
if (argv[5][0] == 'C')
|
dstar_buf[34] = ' ';
|
||||||
dstar_buf[13] = 0x02;
|
dstar_buf[35] = argv[5][0];
|
||||||
else
|
|
||||||
dstar_buf[13] = 0x00;
|
/* YRCALL */
|
||||||
|
memcpy(dstar_buf + 36, argv[9], strlen(argv[9]));
|
||||||
dstar_buf[14] = (unsigned char)(streamid_raw & 0xFF);
|
if (strlen(argv[9]) < 8)
|
||||||
dstar_buf[15] = (unsigned char)((streamid_raw >> 8) & 0xFF);
|
memset(dstar_buf + 36 + strlen(argv[9]), ' ', 8 - strlen(argv[9]));
|
||||||
dstar_buf[16] = 0x80;
|
|
||||||
dstar_buf[17] = 0x00;
|
/* MYCALL */
|
||||||
dstar_buf[18] = 0x00;
|
memcpy(dstar_buf + 44, argv[8], strlen(argv[8]));
|
||||||
dstar_buf[19] = 0x00;
|
if (strlen(argv[8]) < 8)
|
||||||
|
memset(dstar_buf + 44 + strlen(argv[8]), ' ', 8 - strlen(argv[8]));
|
||||||
/* RPT2 */
|
|
||||||
memcpy(dstar_buf + 20, argv[4], strlen(argv[4]));
|
/* suffix */
|
||||||
if (strlen(argv[4]) < 6)
|
memcpy(dstar_buf + 52, " ", 4);
|
||||||
memset(dstar_buf + 20 + strlen(argv[4]), ' ', 6 - strlen(argv[4]));
|
calcPFCS(dstar_buf);
|
||||||
dstar_buf[26] = ' ';
|
(void)sendto(sockDst,(char *)dstar_buf,58,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
||||||
dstar_buf[27] = 'G';
|
G2_COUNTER ++;
|
||||||
|
usleep(delay);
|
||||||
/* RPT1 */
|
|
||||||
memcpy(dstar_buf + 28, argv[4], strlen(argv[4]));
|
dstar_buf[9] = 0x13;
|
||||||
if (strlen(argv[4]) < 6)
|
memcpy((char *)dstar_buf + 17, silence, 9);
|
||||||
memset(dstar_buf + 28 + strlen(argv[4]), ' ', 6 - strlen(argv[4]));
|
|
||||||
dstar_buf[34] = ' ';
|
/* start sending silence + text */
|
||||||
dstar_buf[35] = argv[5][0];
|
|
||||||
|
/* SYNC */
|
||||||
/* YRCALL */
|
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
||||||
memcpy(dstar_buf + 36, argv[9], strlen(argv[9]));
|
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
||||||
if (strlen(argv[9]) < 8)
|
dstar_buf[16] = 0x00;
|
||||||
memset(dstar_buf + 36 + strlen(argv[9]), ' ', 8 - strlen(argv[9]));
|
dstar_buf[26] = 0x55;
|
||||||
|
dstar_buf[27] = 0x2d;
|
||||||
/* MYCALL */
|
dstar_buf[28] = 0x16;
|
||||||
memcpy(dstar_buf + 44, argv[8], strlen(argv[8]));
|
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
||||||
if (strlen(argv[8]) < 8)
|
G2_COUNTER ++;
|
||||||
memset(dstar_buf + 44 + strlen(argv[8]), ' ', 8 - strlen(argv[8]));
|
usleep(delay);
|
||||||
|
|
||||||
/* suffix */
|
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
||||||
memcpy(dstar_buf + 52, " ", 4);
|
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
||||||
calcPFCS(dstar_buf);
|
dstar_buf[16] = 0x01;
|
||||||
(void)sendto(sockDst,(char *)dstar_buf,58,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
dstar_buf[26] = '@' ^ 0x70;
|
||||||
G2_COUNTER ++;
|
dstar_buf[27] = RADIO_ID[0] ^ 0x4f;
|
||||||
usleep(delay);
|
dstar_buf[28] = RADIO_ID[1] ^ 0x93;
|
||||||
|
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
||||||
dstar_buf[9] = 0x13;
|
G2_COUNTER ++;
|
||||||
memcpy((char *)dstar_buf + 17, silence, 9);
|
usleep(delay);
|
||||||
|
|
||||||
/* start sending silence + text */
|
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
||||||
|
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
||||||
/* SYNC */
|
dstar_buf[16] = 0x02;
|
||||||
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
dstar_buf[26] = RADIO_ID[2] ^ 0x70;
|
||||||
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
dstar_buf[27] = RADIO_ID[3] ^ 0x4f;
|
||||||
dstar_buf[16] = 0x00;
|
dstar_buf[28] = RADIO_ID[4] ^ 0x93;
|
||||||
dstar_buf[26] = 0x55;
|
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
||||||
dstar_buf[27] = 0x2d;
|
G2_COUNTER ++;
|
||||||
dstar_buf[28] = 0x16;
|
usleep(delay);
|
||||||
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
|
||||||
G2_COUNTER ++;
|
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
||||||
usleep(delay);
|
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
||||||
|
dstar_buf[16] = 0x03;
|
||||||
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
dstar_buf[26] = 'A' ^ 0x70;
|
||||||
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
dstar_buf[27] = RADIO_ID[5] ^ 0x4f;
|
||||||
dstar_buf[16] = 0x01;
|
dstar_buf[28] = RADIO_ID[6] ^ 0x93;
|
||||||
dstar_buf[26] = '@' ^ 0x70;
|
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
||||||
dstar_buf[27] = RADIO_ID[0] ^ 0x4f;
|
G2_COUNTER ++;
|
||||||
dstar_buf[28] = RADIO_ID[1] ^ 0x93;
|
usleep(delay);
|
||||||
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
|
||||||
G2_COUNTER ++;
|
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
||||||
usleep(delay);
|
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
||||||
|
dstar_buf[16] = 0x04;
|
||||||
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
dstar_buf[26] = RADIO_ID[7] ^ 0x70;
|
||||||
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
dstar_buf[27] = RADIO_ID[8] ^ 0x4f;
|
||||||
dstar_buf[16] = 0x02;
|
dstar_buf[28] = RADIO_ID[9] ^ 0x93;
|
||||||
dstar_buf[26] = RADIO_ID[2] ^ 0x70;
|
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
||||||
dstar_buf[27] = RADIO_ID[3] ^ 0x4f;
|
G2_COUNTER ++;
|
||||||
dstar_buf[28] = RADIO_ID[4] ^ 0x93;
|
usleep(delay);
|
||||||
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
|
||||||
G2_COUNTER ++;
|
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
||||||
usleep(delay);
|
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
||||||
|
dstar_buf[16] = 0x05;
|
||||||
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
dstar_buf[26] = 'B' ^ 0x70;
|
||||||
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
dstar_buf[27] = RADIO_ID[10] ^ 0x4f;
|
||||||
dstar_buf[16] = 0x03;
|
dstar_buf[28] = RADIO_ID[11] ^ 0x93;
|
||||||
dstar_buf[26] = 'A' ^ 0x70;
|
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
||||||
dstar_buf[27] = RADIO_ID[5] ^ 0x4f;
|
G2_COUNTER ++;
|
||||||
dstar_buf[28] = RADIO_ID[6] ^ 0x93;
|
usleep(delay);
|
||||||
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
|
||||||
G2_COUNTER ++;
|
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
||||||
usleep(delay);
|
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
||||||
|
dstar_buf[16] = 0x06;
|
||||||
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
dstar_buf[26] = RADIO_ID[12] ^ 0x70;
|
||||||
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
dstar_buf[27] = RADIO_ID[13] ^ 0x4f;
|
||||||
dstar_buf[16] = 0x04;
|
dstar_buf[28] = RADIO_ID[14] ^ 0x93;
|
||||||
dstar_buf[26] = RADIO_ID[7] ^ 0x70;
|
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
||||||
dstar_buf[27] = RADIO_ID[8] ^ 0x4f;
|
G2_COUNTER ++;
|
||||||
dstar_buf[28] = RADIO_ID[9] ^ 0x93;
|
usleep(delay);
|
||||||
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
|
||||||
G2_COUNTER ++;
|
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
||||||
usleep(delay);
|
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
||||||
|
dstar_buf[16] = 0x07;
|
||||||
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
dstar_buf[26] = 'C' ^ 0x70;
|
||||||
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
dstar_buf[27] = RADIO_ID[15] ^ 0x4f;
|
||||||
dstar_buf[16] = 0x05;
|
dstar_buf[28] = RADIO_ID[16] ^ 0x93;
|
||||||
dstar_buf[26] = 'B' ^ 0x70;
|
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
||||||
dstar_buf[27] = RADIO_ID[10] ^ 0x4f;
|
G2_COUNTER ++;
|
||||||
dstar_buf[28] = RADIO_ID[11] ^ 0x93;
|
usleep(delay);
|
||||||
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
|
||||||
G2_COUNTER ++;
|
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
||||||
usleep(delay);
|
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
||||||
|
dstar_buf[16] = 0x08;
|
||||||
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
dstar_buf[26] = RADIO_ID[17] ^ 0x70;
|
||||||
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
dstar_buf[27] = RADIO_ID[18] ^ 0x4f;
|
||||||
dstar_buf[16] = 0x06;
|
dstar_buf[28] = RADIO_ID[19] ^ 0x93;
|
||||||
dstar_buf[26] = RADIO_ID[12] ^ 0x70;
|
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
||||||
dstar_buf[27] = RADIO_ID[13] ^ 0x4f;
|
G2_COUNTER ++;
|
||||||
dstar_buf[28] = RADIO_ID[14] ^ 0x93;
|
usleep(delay);
|
||||||
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
|
||||||
G2_COUNTER ++;
|
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
||||||
usleep(delay);
|
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
||||||
|
dstar_buf[16] = 0x09 | 0x40;
|
||||||
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
|
||||||
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
memset((char *)dstar_buf + 17, '\0', 9);
|
||||||
dstar_buf[16] = 0x07;
|
|
||||||
dstar_buf[26] = 'C' ^ 0x70;
|
dstar_buf[26] = 0x70;
|
||||||
dstar_buf[27] = RADIO_ID[15] ^ 0x4f;
|
dstar_buf[27] = 0x4f;
|
||||||
dstar_buf[28] = RADIO_ID[16] ^ 0x93;
|
dstar_buf[28] = 0x93;
|
||||||
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
||||||
G2_COUNTER ++;
|
G2_COUNTER ++;
|
||||||
usleep(delay);
|
usleep(delay);
|
||||||
|
|
||||||
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
dst_close();
|
||||||
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
}
|
||||||
dstar_buf[16] = 0x08;
|
|
||||||
dstar_buf[26] = RADIO_ID[17] ^ 0x70;
|
printf("g2link_test exiting...\n");
|
||||||
dstar_buf[27] = RADIO_ID[18] ^ 0x4f;
|
return 0;
|
||||||
dstar_buf[28] = RADIO_ID[19] ^ 0x93;
|
}
|
||||||
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
|
||||||
G2_COUNTER ++;
|
|
||||||
usleep(delay);
|
|
||||||
|
|
||||||
dstar_buf[5] = (unsigned char)(G2_COUNTER & 0xff);
|
|
||||||
dstar_buf[4] = (unsigned char)((G2_COUNTER >> 8) & 0xff);
|
|
||||||
dstar_buf[16] = 0x09 | 0x40;
|
|
||||||
|
|
||||||
memset((char *)dstar_buf + 17, '\0', 9);
|
|
||||||
|
|
||||||
dstar_buf[26] = 0x70;
|
|
||||||
dstar_buf[27] = 0x4f;
|
|
||||||
dstar_buf[28] = 0x93;
|
|
||||||
(void)sendto(sockDst,(char *)dstar_buf,29,0,(struct sockaddr *)&toDst,sizeof(toDst));
|
|
||||||
G2_COUNTER ++;
|
|
||||||
usleep(delay);
|
|
||||||
|
|
||||||
dst_close();
|
|
||||||
}
|
|
||||||
|
|
||||||
printf("g2link_test exiting...\n");
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|||||||
Loading…
Reference in new issue