You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
173 lines
3.8 KiB
173 lines
3.8 KiB
/*
|
|
Copyright Jeroen Vreeken (jeroen@vreeken.net), 2016
|
|
|
|
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 3 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/>.
|
|
|
|
*/
|
|
#include "interface.h"
|
|
#include <eth_ar/fprs.h>
|
|
#include <eth_ar/eth_ar.h>
|
|
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include <time.h>
|
|
#include <sys/select.h>
|
|
|
|
static char *netname = "freedv";
|
|
static uint8_t taddr[6];
|
|
static enum fprs_type el = FPRS_ERROR;
|
|
static bool done = false;
|
|
|
|
static int cb(uint8_t to[6], uint8_t from[6], uint16_t eth_type, uint8_t *data, size_t len)
|
|
{
|
|
struct fprs_frame *frame = fprs_frame_create();
|
|
if (!frame)
|
|
return -1;
|
|
|
|
fprs_frame_data_set(frame, data, len);
|
|
|
|
struct fprs_element *el_callsign;
|
|
struct fprs_element *el_requested;
|
|
|
|
el_callsign = fprs_frame_element_by_type(frame, FPRS_CALLSIGN);
|
|
el_requested = fprs_frame_element_by_type(frame, el);
|
|
|
|
if (!el_callsign || !el_requested)
|
|
goto skip;
|
|
|
|
if (memcmp(taddr, fprs_element_data(el_callsign), 6))
|
|
goto skip;
|
|
|
|
char *el_str = fprs_element2stra(el_requested);
|
|
printf("%s\n", el_str);
|
|
free(el_str);
|
|
|
|
done = true;
|
|
skip:
|
|
fprs_frame_destroy(frame);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void usage(void)
|
|
{
|
|
printf("Options:\n");
|
|
printf("-e [element]\telement type\n");
|
|
printf("-c [call]\town callsign\n");
|
|
printf("-t [call]\ttarget callsign\n");
|
|
printf("-n [dev]\tNetwork device name (default: \"%s\")\n", netname);
|
|
}
|
|
|
|
|
|
int main(int argc, char **argv)
|
|
{
|
|
int opt;
|
|
int fd_int;
|
|
uint8_t bcast[6] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
|
|
uint8_t myaddr[6];
|
|
char *call = NULL;
|
|
char *target = NULL;
|
|
time_t stop_listen = 60;
|
|
time_t interval = 10;
|
|
time_t retry;
|
|
|
|
while ((opt = getopt(argc, argv, "c:n:t:e:")) != -1) {
|
|
switch(opt) {
|
|
case 'c':
|
|
call = optarg;
|
|
break;
|
|
case 'e':
|
|
el = atoi(optarg);
|
|
break;
|
|
case 't':
|
|
target = optarg;
|
|
break;
|
|
case 'n':
|
|
netname = optarg;
|
|
break;
|
|
default:
|
|
goto err_usage;
|
|
}
|
|
}
|
|
|
|
fd_int = interface_init(netname, NULL, false, ETH_P_FPRS);
|
|
if (fd_int < 0) {
|
|
printf("Could not open interface: %s\n", strerror(errno));
|
|
return -1;
|
|
}
|
|
|
|
if (!call || eth_ar_callssid2mac(myaddr, call, false)) {
|
|
printf("From callsign could not be converted to a valid MAC address\n");
|
|
goto err_usage;
|
|
}
|
|
if (!target || eth_ar_callssid2mac(taddr, target, false)) {
|
|
printf("Target callsign could not be converted to a valid MAC address\n");
|
|
goto err_usage;
|
|
}
|
|
|
|
struct fprs_frame *frame = fprs_frame_create();
|
|
|
|
fprs_frame_add_callsign(frame, myaddr);
|
|
fprs_frame_add_request(frame, taddr, &el, 1);
|
|
|
|
uint8_t *data;
|
|
size_t size;
|
|
|
|
size = fprs_frame_data_size(frame);
|
|
data = calloc(size, sizeof(uint8_t));
|
|
if (!data)
|
|
goto err_fatal;
|
|
fprs_frame_data_get(frame, data, &size);
|
|
|
|
stop_listen += time(NULL);
|
|
retry = time(NULL);
|
|
|
|
do {
|
|
struct timeval timeout;
|
|
|
|
if (retry > stop_listen) {
|
|
retry = stop_listen;
|
|
}
|
|
timeout.tv_usec = 0;
|
|
timeout.tv_sec = retry - time(NULL);
|
|
if (timeout.tv_sec < 0)
|
|
timeout.tv_sec = 0;
|
|
|
|
fd_set fdr;
|
|
|
|
FD_ZERO(&fdr);
|
|
FD_SET(fd_int, &fdr);
|
|
|
|
select(fd_int + 1, &fdr, NULL, NULL, &timeout);
|
|
|
|
if (FD_ISSET(fd_int, &fdr)) {
|
|
interface_tx_raw(cb);
|
|
}
|
|
if (!done) {
|
|
interface_rx_raw(bcast, myaddr, ETH_P_FPRS, data, size);
|
|
retry += interval;
|
|
}
|
|
} while (!done && time(NULL) < stop_listen);
|
|
free(data);
|
|
|
|
return 0;
|
|
|
|
err_fatal:
|
|
printf("FATAL ERROR\n");
|
|
err_usage:
|
|
usage();
|
|
return -1;
|
|
}
|