FreeCalypso > hg > freecalypso-sw
view rvinterf/lowlevel/rvifmain.c @ 177:fef035264dd4
rvinterf: beginning of local socket handling
author | Michael Spacefalcon <msokolov@ivan.Harhan.ORG> |
---|---|
date | Sat, 23 Nov 2013 20:15:02 +0000 |
parents | 7f727aaf5cd4 |
children | 7ab6b29e76bb |
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 <stdlib.h> #include <unistd.h> #include <time.h> #include "../pktmux.h" #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; char *logfname; FILE *logF; time_t logtime; int background; int max_fd; 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:")) != EOF) switch (c) { case 'b': background++; continue; case 'B': baudrate_name = optarg; continue; case 'd': target_fd = atoi(optarg); continue; case 'l': logfname = optarg; 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); } fprintf(logF, "*** Log of rvinterf session ***\n"); setlinebuf(logF); } 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); } } for (;;) { FD_ZERO(&fds); FD_SET(target_fd, &fds); 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; } 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 (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; print_rv_trace(); return; case RVT_L1_HEADER: print_l1_trace(); return; case RVT_L23_HEADER: print_g23_trace(); return; case RVT_TM_HEADER: print_etm_output_raw(); return; default: unknown: print_unknown_packet(); } }