FreeCalypso > hg > freecalypso-sw
view rvinterf/lowlevel/rvifmain.c @ 856:d527ac304ad5
rvinterf & rvtdump: handle low level debug messages from FC firmwares
author | Space Falcon <falcon@ivan.Harhan.ORG> |
---|---|
date | Thu, 30 Apr 2015 07:40:30 +0000 |
parents | 1171c32a637b |
children | 2682003dcba7 |
line wrap: on
line source
/* * This module contains the main() function for rvinterf */ #include <sys/types.h> #include <sys/errno.h> #include <stdio.h> #include <string.h> #include <strings.h> #include <stdlib.h> #include <unistd.h> #include <signal.h> #include <time.h> #include "../include/pktmux.h" #include "../include/localsock.h" #include "client.h" extern int target_fd, listener; extern char *baudrate_name; extern u_char rxpkt[]; extern size_t rxpkt_len; struct client *client_head; int socketpair_fd; char *logfname; FILE *logF; time_t logtime; int background, no_output; int max_fd; char *socket_pathname = "/tmp/rvinterf_socket"; int wakeup_after_sec = 7; main(argc, argv) char **argv; { extern char *optarg; extern int optind; int c; fd_set fds; struct client *cli, **clip; while ((c = getopt(argc, argv, "bB:d:l:ns:S:w:")) != EOF) switch (c) { case 'b': background++; /* FALL THRU */ case 'n': no_output++; continue; case 'B': baudrate_name = optarg; continue; case 'd': target_fd = atoi(optarg); continue; case 'l': logfname = optarg; continue; case 's': socket_pathname = optarg; continue; case 'S': socketpair_fd = atoi(optarg); continue; case 'w': wakeup_after_sec = strtoul(optarg, 0, 0); continue; case '?': default: usage: fprintf(stderr, "usage: %s [options] ttyport\n", argv[0]); exit(1); } if (target_fd <= 0) { if (argc - optind != 1) goto usage; open_target_serial(argv[optind]); } max_fd = target_fd; set_serial_nonblock(0); setlinebuf(stdout); if (logfname) { logF = fopen(logfname, "w"); if (!logF) { perror(logfname); exit(1); } setlinebuf(logF); fprintf(logF, "*** Log of rvinterf session ***\n"); } if (socketpair_fd) create_socketpair_client(); else create_listener_socket(); if (background) { c = fork(); if (c < 0) { perror("fork"); exit(1); } if (c) { printf("rvinterf forked into background (pid %d)\n", c); exit(0); } } signal(SIGPIPE, SIG_IGN); for (;;) { FD_ZERO(&fds); FD_SET(target_fd, &fds); if (listener) FD_SET(listener, &fds); for (clip = &client_head; cli = *clip; ) { if (cli->rx_state == 2) { close(cli->fd); *clip = cli->next; free(cli); continue; } FD_SET(cli->fd, &fds); clip = &cli->next; } if (socketpair_fd && !client_head) exit(0); c = select(max_fd+1, &fds, 0, 0, 0); time(&logtime); if (c < 0) { if (errno == EINTR) continue; perror("select"); exit(1); } if (FD_ISSET(target_fd, &fds)) process_serial_rx(); if (listener && FD_ISSET(listener, &fds)) handle_listener_select(); for (cli = client_head; cli; cli = cli->next) if (FD_ISSET(cli->fd, &fds)) handle_client_select(cli); } } handle_rx_packet() { switch (rxpkt[0]) { case RVT_RV_HEADER: if (rxpkt_len < 6) goto unknown; if (!no_output || logF) print_rv_trace(); if (client_head) forward_rv_trace(); return; case RVT_L1_HEADER: if (!no_output || logF) print_l1_trace(); if (client_head) forward_nonrvt_pkt(); return; case RVT_L23_HEADER: if (!no_output || logF) print_g23_trace(); if (client_head) forward_nonrvt_pkt(); return; case RVT_TM_HEADER: if (!no_output || logF) print_etm_output_raw(); if (client_head) forward_nonrvt_pkt(); return; case '*': print_fc_lld_msg(); return; default: unknown: print_unknown_packet(); } }