FreeCalypso > hg > sipout-test-utils
view test-fsk/main.c @ 6:ba66d297fe57
test-fsk: first attempt at modem Rx
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Mon, 04 Mar 2024 23:21:07 -0800 |
parents | 030d52b96a23 |
children |
line wrap: on
line source
/* * This is the main module for sip-manual-out test program. */ #include <sys/types.h> #include <sys/time.h> #include <sys/socket.h> #include <sys/errno.h> #include <netinet/in.h> #include <arpa/inet.h> #include <stdio.h> #include <stdlib.h> #include <string.h> #include <strings.h> #include <unistd.h> #include <spandsp.h> #include "../libsip/out_msg.h" #include "../libsip/sdp.h" extern int sip_socket; extern struct in_addr sip_bind_ip, sip_dest_ip; extern unsigned sip_bind_port, sip_dest_port; extern char sip_dest_domain[]; extern struct sockaddr_in rtp_local_addr; extern int rtp_udp_fd, rtcp_udp_fd; extern int rtp_out_enable; struct sockaddr_in sip_dest_sin; char from_uri[128], to_uri[128], call_id[128]; struct timeval cur_event_time; unsigned max_forwards = 70; int declare_100rel_supp; int pcma_codec_pref, pcma_codec_force; int fsk_mode_rx, fsk_mode_tx; send_invite_req() { struct sip_msg_out msg; struct sdp_gen sdp; int rc; rc = start_request_out_msg(&msg, "INVITE", to_uri); if (rc < 0) { msg_size_err: fprintf(stderr, "composing INVITE req: msg size error\n"); exit(1); } rc = add_req_boilerplate(&msg, "1 INVITE", 0); if (rc < 0) goto msg_size_err; rc = add_contact_header(&msg); if (rc < 0) goto msg_size_err; if (declare_100rel_supp) { rc = out_msg_add_header(&msg, "Supported", "100rel"); if (rc < 0) goto msg_size_err; } rc = out_msg_add_header(&msg, "Content-Type", "application/sdp"); if (rc < 0) goto msg_size_err; bzero(&sdp, sizeof sdp); sdp.conn_ip = rtp_local_addr.sin_addr; sdp.conn_port = ntohs(rtp_local_addr.sin_port); if (pcma_codec_force) sdp.codec_mask = SDP_CODEC_MASK_PCMA; else { sdp.codec_mask = SDP_CODEC_MASK_BOTH; if (pcma_codec_pref) sdp.codec_mask |= SDP_CODEC_MASK_PCMA_PREF; } sdp.session_id = sdp.conn_port << 16; sdp.owner_ip = sip_bind_ip; rc = out_msg_finish_sdp(&msg, &sdp); if (rc < 0) goto msg_size_err; sip_tx_packet(&msg, &sip_dest_sin); } static void select_modulation(modname) char *modname; { if (!strcmp(modname, "v21")) { fsk_mode_rx = FSK_V21CH2; fsk_mode_tx = FSK_V21CH1; } else if (!strcmp(modname, "bell103")) { fsk_mode_rx = FSK_BELL103CH2; fsk_mode_tx = FSK_BELL103CH1; } else { fprintf(stderr, "error: modulation name \"%s\" unknown\n", modname); exit(1); } } static void preliminary_proc(argc, argv) char **argv; { extern int optind; extern char *optarg; char *logfile; int opt, rc; logfile = 0; while ((opt = getopt(argc, argv, "aAl:m:r")) != EOF) { switch (opt) { case 'a': pcma_codec_pref = 1; continue; case 'A': pcma_codec_force = 1; continue; case 'l': logfile = optarg; continue; case 'm': max_forwards = atoi(optarg); continue; case 'r': declare_100rel_supp = 1; continue; default: usage: fprintf(stderr, "usage: %s [options] dest-conf from-num to-num mode\n", argv[0]); exit(1); } } if (argc != optind + 4) goto usage; read_config_file(argv[optind]); open_sip_udp_socket(); obtain_rtp_endp(); sip_dest_sin.sin_family = AF_INET; sip_dest_sin.sin_addr = sip_dest_ip; sip_dest_sin.sin_port = htons(sip_dest_port); sprintf(from_uri, "<sip:%s@%s>;tag=out%u", argv[optind+1], inet_ntoa(sip_bind_ip), ntohs(rtp_local_addr.sin_port)); sprintf(to_uri, "sip:%s@%s", argv[optind+2], sip_dest_domain); select_modulation(argv[optind+3]); init_modem_rx(); if (logfile) { rc = open_sip_log_file(logfile); if (rc < 0) exit(1); /* error msg already printed */ } } main(argc, argv) char **argv; { fd_set fds; struct timeval next_rtp_out, timeout; int rc, max_fd, rtp_out_running; preliminary_proc(argc, argv); gettimeofday(&cur_event_time, 0); sprintf(call_id, "%08u_%u@%s", (unsigned)(cur_event_time.tv_sec % 100000000), ntohs(rtp_local_addr.sin_port), inet_ntoa(sip_bind_ip)); send_invite_req(); /* main select loop */ max_fd = sip_socket; if (rtp_udp_fd > max_fd) max_fd = rtp_udp_fd; if (rtcp_udp_fd > max_fd) max_fd = rtcp_udp_fd; rtp_out_running = 0; for (;;) { FD_ZERO(&fds); FD_SET(0, &fds); FD_SET(sip_socket, &fds); FD_SET(rtp_udp_fd, &fds); FD_SET(rtcp_udp_fd, &fds); if (rtp_out_enable) { if (!rtp_out_running) { printf("Starting RTP output\n"); bcopy(&cur_event_time, &next_rtp_out, sizeof(struct timeval)); rtp_out_running = 1; } if (timercmp(&cur_event_time, &next_rtp_out, <)) timersub(&next_rtp_out, &cur_event_time, &timeout); else timerclear(&timeout); rc = select(max_fd+1, &fds, 0, 0, &timeout); } else { if (rtp_out_running) { printf("Stopping RTP output\n"); rtp_out_running = 0; } rc = select(max_fd+1, &fds, 0, 0, 0); } if (rc < 0) { if (errno == EINTR) continue; perror("select"); exit(1); } gettimeofday(&cur_event_time, 0); if (FD_ISSET(0, &fds)) select_stdin(); if (FD_ISSET(sip_socket, &fds)) sip_socket_select(); if (FD_ISSET(rtp_udp_fd, &fds)) rtp_rx_select(); if (FD_ISSET(rtcp_udp_fd, &fds)) rtcp_rx_select(); if (rtp_out_running && (rc == 0)) { generate_rtp_packet(); next_rtp_out.tv_usec += 20000; if (next_rtp_out.tv_usec >= 1000000) { next_rtp_out.tv_sec++; next_rtp_out.tv_usec -= 1000000; } } } }