FreeCalypso > hg > themwi-system-sw
view mtctest/setup.c @ 57:d61d0136f6a5
sip-in INVITE processing: return "GSM service is offline" indication
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 08 Sep 2022 13:39:42 -0800 |
parents | 08d7794cdd0a |
children | 5141e21596bb |
line wrap: on
line source
/* * In this module we compose the MNCC_SETUP_REQ message * initiating our test MT call. */ #include <sys/types.h> #include <sys/socket.h> #include <ctype.h> #include <stdio.h> #include <stdint.h> #include <stdlib.h> #include <string.h> #include <strings.h> #include "../include/mncc.h" #include "../include/gsm48_const.h" struct gsm_mncc setup_msg; static void set_called_number(arg) char *arg; { int rc, ndig; char short_num[5], long_num[12]; if (!strncmp(arg, "imsi:", 5)) { rc = grok_imsi_user_arg(arg, setup_msg.imsi); if (rc < 0) { fprintf(stderr, "error: call-by-IMSI destination \"%s\" is invalid\n", arg); exit(1); } return; } if (arg[0] == '+') { if (arg[1] != '1') { fprintf(stderr, "error: plus-format call destination number must begin with 1\n"); exit(1); } if (grok_number_string(arg+1, 1) != 11) { bad_plus1: fprintf(stderr, "error: malformed +1 call destination number\n"); exit(1); } dehyphen_number_string(arg+1, setup_msg.called.number); if (!is_nanp_valid_prefix(setup_msg.called.number+1)) goto bad_plus1; setup_msg.called.type = GSM48_TON_INTERNATIONAL; setup_msg.called.plan = GSM48_NPI_ISDN_E164; setup_msg.fields |= MNCC_F_CALLED; return; } ndig = grok_number_string(arg, 1); switch (ndig) { case 4: dehyphen_number_string(arg, short_num); if (read_number_db() < 0) { fprintf(stderr, "error reading number database\n"); exit(1); } rc = lookup_short_dial_number(short_num, long_num); if (!rc) { fprintf(stderr, "error: short dial number %s is not valid\n", short_num); exit(1); } if (long_num[0]) { setup_msg.called.type = GSM48_TON_INTERNATIONAL; setup_msg.called.plan = GSM48_NPI_ISDN_E164; setup_msg.called.number[0] = '1'; strcpy(setup_msg.called.number+1, long_num); } else { setup_msg.called.type = GSM48_TON_NET_SPEC; setup_msg.called.plan = GSM48_NPI_PRIVATE; strcpy(setup_msg.called.number, short_num); } setup_msg.fields |= MNCC_F_CALLED; return; case 10: dehyphen_number_string(arg, long_num); if (!is_nanp_valid_prefix(long_num)) break; setup_msg.called.type = GSM48_TON_INTERNATIONAL; setup_msg.called.plan = GSM48_NPI_ISDN_E164; setup_msg.called.number[0] = '1'; strcpy(setup_msg.called.number+1, long_num); setup_msg.fields |= MNCC_F_CALLED; return; case 11: dehyphen_number_string(arg, long_num); if (long_num[0] != '1') break; if (!is_nanp_valid_prefix(long_num+1)) break; setup_msg.called.type = GSM48_TON_INTERNATIONAL; setup_msg.called.plan = GSM48_NPI_ISDN_E164; strcpy(setup_msg.called.number, long_num); setup_msg.fields |= MNCC_F_CALLED; return; } fprintf(stderr, "error: call destination number \"%s\" is invalid\n", arg); exit(1); } static void set_calling_number(arg) char *arg; { unsigned ndig; int c; if (!strcmp(arg, "unavail")) { setup_msg.calling.present = GSM48_PRES_UNAVAIL; return; } if (!strcmp(arg, "blocked")) { setup_msg.calling.present = GSM48_PRES_RESTR; return; } if (*arg == '+') { setup_msg.calling.type = GSM48_TON_INTERNATIONAL; arg++; } for (ndig = 0; *arg; ) { c = *arg++; if (c == ',') break; if (c == '-') continue; if (!is_valid_ext_digit(c)) { fprintf(stderr, "error: calling number argument contains invalid digit \'%c\'\n", c); exit(1); } if (ndig >= 32) { fprintf(stderr, "error: calling number argument is too long\n"); exit(1); } setup_msg.calling.number[ndig] = c; ndig++; } if (!ndig) { fprintf(stderr, "error: calling number argument has no digits\n"); exit(1); } setup_msg.calling.plan = GSM48_NPI_ISDN_E164; for (;;) { while (*arg == ',') arg++; if (!*arg) return; if (!strncmp(arg, "ton=", 4)) { arg += 4; if (arg[0] >= '0' && arg[1] <= '7' && !isdigit(arg[1])){ setup_msg.calling.type = *arg - '0'; arg++; } else { fprintf(stderr, "error: calling number argument contains invalid ton= part\n"); exit(1); } } else if (!strncmp(arg, "npi=", 4)) { arg += 4; if (arg[0] >= '0' && arg[1] <= '9' && !isdigit(arg[1])){ setup_msg.calling.plan = *arg - '0'; arg++; } else if (arg[0] == '1' && arg[1] >= '0' && arg[1] <= '5' && !isdigit(arg[2])) { setup_msg.calling.plan = atoi(arg); arg += 2; } else { fprintf(stderr, "error: calling number argument contains invalid npi= part\n"); exit(1); } } else if (!strncmp(arg, "restr", 5)) { arg += 5; setup_msg.calling.present = GSM48_PRES_RESTR; } else if (!strncmp(arg, "vp", 2)) { arg += 2; setup_msg.calling.screen = GSM48_SCRN_USER_PASS; } else if (!strncmp(arg, "vf", 2)) { arg += 2; setup_msg.calling.screen = GSM48_SCRN_USER_FAIL; } else if (!strncmp(arg, "net", 3)) { arg += 3; setup_msg.calling.screen = GSM48_SCRN_NETWORK; } else { inv_qual: fprintf(stderr, "error: calling number argument contains invalid qualifier\n"); exit(1); } if (!*arg) return; if (*arg != ',') goto inv_qual; } } void init_setup_msg(from, to) char *from, *to; { setup_msg.msg_type = MNCC_SETUP_REQ; setup_msg.callref = 1; set_called_number(to); if (from) { set_calling_number(from); setup_msg.fields |= MNCC_F_CALLING; } } void send_setup_msg() { if (setup_msg.imsi[0]) printf("Calling IMSI %s\n", setup_msg.imsi); else printf("Calling %s%s\n", setup_msg.called.type == GSM48_TON_INTERNATIONAL ? "+" : "", setup_msg.called.number); send_mncc_to_gsm(&setup_msg, sizeof(struct gsm_mncc)); }