FreeCalypso > hg > freecalypso-tools
changeset 598:9f7a263ad7f0
sms-pdu-decode split in preparation for pcm-sms-decode addition
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sat, 08 Feb 2020 00:48:28 +0000 |
parents | ca4433b714d2 |
children | 18bfc10ba20e |
files | uptools/sms-pdu-decode/Makefile uptools/sms-pdu-decode/pdu-common.c uptools/sms-pdu-decode/sms-pdu-decode.c |
diffstat | 3 files changed, 412 insertions(+), 382 deletions(-) [+] |
line wrap: on
line diff
--- a/uptools/sms-pdu-decode/Makefile Tue Feb 04 18:22:22 2020 +0000 +++ b/uptools/sms-pdu-decode/Makefile Sat Feb 08 00:48:28 2020 +0000 @@ -1,21 +1,22 @@ CC= gcc CFLAGS= -O2 -PROG= sms-pdu-decode +PROGS= sms-pdu-decode LIB= ../libcoding/libcoding.a -OBJS= ${PROG}.o ${LIB} + +OBJS1= pdu-common.o sms-pdu-decode.o ${LIB} INSTALL_PREFIX= /opt/freecalypso INSTBIN=${INSTALL_PREFIX}/bin -all: ${PROG} +all: ${PROGS} -${PROG}: ${OBJS} - ${CC} ${CFLAGS} -o $@ ${OBJS} +sms-pdu-decode: ${OBJS1} + ${CC} ${CFLAGS} -o $@ ${OBJS1} install: mkdir -p ${INSTBIN} - install -c ${PROG} ${INSTBIN} + install -c ${PROGS} ${INSTBIN} clean: - rm -f ${PROG} *.o *errs *.out + rm -f ${PROGS} *.o *errs *.out
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/uptools/sms-pdu-decode/pdu-common.c Sat Feb 08 00:48:28 2020 +0000 @@ -0,0 +1,395 @@ +#include <sys/types.h> +#include <ctype.h> +#include <stdio.h> +#include <stdlib.h> +#include <string.h> +#include <strings.h> + +int ascii_ext_mode, global_hexdump_mode; + +u_char pdu[176]; +unsigned pdu_length; + +static u_char first_octet; +static unsigned pdu_ptr; +static int dcs_distilled; + +static +handle_sca() +{ + unsigned sca_len; + char digits[21]; + + sca_len = pdu[0]; + pdu_ptr = 1; + if (!sca_len) + return(0); + if (sca_len < 2 || sca_len > 11) { + printf("Decode-Error: invalid SCA length\n"); + return(-1); + } + if (pdu_ptr + sca_len > pdu_length) { + printf("Decode-Error: SCA goes past PDU end\n"); + return(-1); + } + pdu_ptr += sca_len; + decode_address_digits(pdu + 2, digits, sc_addr_ndigits(pdu)); + printf("SCA: %s%s (type 0x%02X)\n", pdu[1] == 0x91 ? "+" : "", digits, + pdu[1]); + return(0); +} + +static +handle_first_octet() +{ + if (pdu_ptr >= pdu_length) { + printf("Decode-Error: end of PDU before FO\n"); + return(-1); + } + first_octet = pdu[pdu_ptr++]; + printf("First-Octet: 0x%02X\n", first_octet); + return(0); +} + +static +handle_mr() +{ + if (pdu_ptr >= pdu_length) { + printf("Decode-Error: end of PDU before MR\n"); + return(-1); + } + printf("MR: 0x%02X\n", pdu[pdu_ptr++]); + return(0); +} + +static +handle_user_addr(direction) + char *direction; +{ + unsigned addr_field_len, alpha_nsep; + char digits[21]; + u_char alpha_gsm7[11], alpha_decoded[23]; + + if (pdu_ptr >= pdu_length) { + printf("Decode-Error: end of PDU before %s address\n", + direction); + return(-1); + } + if (pdu[pdu_ptr] > 20) { + printf("Decode-Error: %s address > 20 digits\n", direction); + return(-1); + } + addr_field_len = ((pdu[pdu_ptr] + 1) >> 1) + 2; + if (pdu_ptr + addr_field_len > pdu_length) { + printf("Decode-Error: %s address goes past PDU end\n", + direction); + return(-1); + } + if (!pdu[pdu_ptr]) + printf("%s: empty-addr (type 0x%02X)\n", direction, + pdu[pdu_ptr+1]); + else if ((pdu[pdu_ptr+1] & 0x70) == 0x50 && + alpha_addr_valid(pdu[pdu_ptr], &alpha_nsep)) { + gsm7_unpack(pdu + pdu_ptr + 2, alpha_gsm7, alpha_nsep); + gsm7_to_ascii_or_ext(alpha_gsm7, alpha_nsep, alpha_decoded, + (unsigned *) 0, ascii_ext_mode, 0, + (unsigned *) 0); + printf("%s: \"%s\" (type 0x%02X)\n", direction, alpha_decoded, + pdu[pdu_ptr+1]); + } else { + decode_address_digits(pdu + pdu_ptr + 2, digits, pdu[pdu_ptr]); + printf("%s: %s%s (type 0x%02X)\n", direction, + pdu[pdu_ptr+1] == 0x91 ? "+" : "", digits, + pdu[pdu_ptr+1]); + } + pdu_ptr += addr_field_len; + return(0); +} + +static +handle_pid() +{ + if (pdu_ptr >= pdu_length) { + printf("Decode-Error: end of PDU before PID\n"); + return(-1); + } + printf("PID: 0x%02X\n", pdu[pdu_ptr++]); + return(0); +} + +static +handle_dcs() +{ + u_char dcs; + char *strtype; + + if (pdu_ptr >= pdu_length) { + printf("Decode-Error: end of PDU before DCS\n"); + return(-1); + } + dcs = pdu[pdu_ptr++]; + dcs_distilled = sms_dcs_classify(dcs); + switch (dcs_distilled) { + case 7: + strtype = "7-bit"; + break; + case 8: + strtype = "raw octets"; + break; + case 9: + strtype = "compressed"; + break; + case 16: + strtype = "UCS-2"; + break; + } + printf("DCS: 0x%02X (%s)\n", dcs, strtype); + return(0); +} + +static +handle_scts() +{ + char str[21]; + + if (pdu_ptr + 7 > pdu_length) { + printf("Decode-Error: end of PDU before SCTS\n"); + return(-1); + } + gsm_timestamp_decode(pdu + pdu_ptr, str); + printf("SC-Timestamp: %s\n", str); + pdu_ptr += 7; + return(0); +} + +static +handle_vp_abs() +{ + char str[21]; + + if (pdu_ptr + 7 > pdu_length) { + printf("Decode-Error: end of PDU before VP-abs\n"); + return(-1); + } + gsm_timestamp_decode(pdu + pdu_ptr, str); + printf("VP-Absolute: %s\n", str); + pdu_ptr += 7; + return(0); +} + +static +handle_vp_rel() +{ + unsigned vprel, hours, min; + + if (pdu_ptr >= pdu_length) { + printf("Decode-Error: end of PDU before VP-rel\n"); + return(-1); + } + vprel = pdu[pdu_ptr++]; + if (vprel <= 143) { + min = (vprel + 1) * 5; + goto hhmm; + } else if (vprel <= 167) { + min = (vprel - 143) * 30 + 12 * 60; + goto hhmm; + } else if (vprel <= 196) { + printf("VP-Relative: %u days\n", vprel - 166); + return(0); + } else { + printf("VP-Relative: %u weeks\n", vprel - 192); + return(0); + } + +hhmm: hours = min / 60; + min %= 60; + printf("VP-Relative: "); + if (hours) + printf(" %u hour%s", hours, hours != 1 ? "s" : ""); + if (min) + printf(" %u min", min); + putchar('\n'); + return(0); +} + +static +handle_vp_enh() +{ + if (pdu_ptr + 7 > pdu_length) { + printf("Decode-Error: end of PDU before VP-enh\n"); + return(-1); + } + printf("VP-Enhanced: %02X %02X %02X %02X %02X %02X %02X\n", + pdu[pdu_ptr], pdu[pdu_ptr+1], pdu[pdu_ptr+2], pdu[pdu_ptr+3], + pdu[pdu_ptr+4], pdu[pdu_ptr+5], pdu[pdu_ptr+6]); + pdu_ptr += 7; + return(0); +} + +static +handle_vp() +{ + int rc; + + switch (first_octet & 0x18) { + case 0x00: + rc = 0; + break; + case 0x08: + rc = handle_vp_enh(); + break; + case 0x10: + rc = handle_vp_rel(); + break; + case 0x18: + rc = handle_vp_abs(); + break; + } + return(rc); +} + +process_pdu() +{ + unsigned udl, udl_octets; + unsigned udhl, udh_octets, udh_chars, ud_chars; + u_char ud7[160], decode_buf[321]; + int do_hexdump; + unsigned decoded_len, badchars; + + if (handle_sca() < 0) + return(-1); + if (handle_first_octet() < 0) + return(-1); + if (first_octet & 2) { + printf("Decode-Error: MTI not supported\n"); + return(-1); + } + if (first_octet & 1) { + if (handle_mr() < 0) + return(-1); + } + if (handle_user_addr(first_octet & 1 ? "To" : "From") < 0) + return(-1); + if (handle_pid() < 0) + return(-1); + if (handle_dcs() < 0) + return(-1); + if (first_octet & 1) { + if (handle_vp() < 0) + return(-1); + } else { + if (handle_scts() < 0) + return(-1); + } + if (pdu_ptr >= pdu_length) { + printf("Decode-Error: end of PDU before UDL\n"); + return(-1); + } + udl = pdu[pdu_ptr++]; + if (dcs_distilled == 7) { + if (udl > 160) { + printf("Decode-Error: UDL %u > 160\n", udl); + return(-1); + } + udl_octets = (udl * 7 + 7) / 8; + } else { + if (udl > 140) { + printf("Decode-Error: UDL %u > 140\n", udl); + return(-1); + } + udl_octets = udl; + } + if (pdu_length - pdu_ptr != udl_octets) { + printf("Decode-Error: UD length in PDU %u != expected %u\n", + pdu_length - pdu_ptr, udl_octets); + return(-1); + } + if (first_octet & 0x40) { + if (!udl) { + printf("Decode-Error: UDHI set with UDL=0\n"); + return(-1); + } + udhl = pdu[pdu_ptr]; + udh_octets = udhl + 1; + if (udh_octets > udl_octets) { + printf("Decode-Error: UDHL exceeds UDL\n"); + return(-1); + } + printf("UDH-Length: %u\n", udhl); + if (dcs_distilled == 7) + udh_chars = (udh_octets * 8 + 6) / 7; + else + udh_chars = udh_octets; + } else { + udhl = 0; + udh_octets = 0; + udh_chars = 0; + } + if (udh_chars >= udl) { + ud_chars = 0; + printf("Length: 0\n"); + } else { + ud_chars = udl - udh_chars; + if (dcs_distilled == 7) + gsm7_unpack(pdu + pdu_ptr, ud7, udl); + if (global_hexdump_mode) + do_hexdump = 1; + else switch (dcs_distilled) { + case 7: + do_hexdump = 0; + break; + case 8: + case 9: + do_hexdump = 1; + break; + case 16: + if (ud_chars & 1) + do_hexdump = 1; + else + do_hexdump = 0; + break; + } + if (do_hexdump) + printf("Length: %u (raw)\n", ud_chars); + else { + switch (dcs_distilled) { + case 7: + gsm7_to_ascii_or_ext(ud7 + udh_chars, ud_chars, + decode_buf, &decoded_len, + ascii_ext_mode, 1, + &badchars); + break; + case 16: + ucs2_to_ascii_or_ext(pdu + pdu_ptr + udh_chars, + ud_chars, + decode_buf, &decoded_len, + ascii_ext_mode, 1, + &badchars); + break; + } + printf("Length: %u", ud_chars); + if (decoded_len != ud_chars) + printf("->%u", decoded_len); + if (badchars) + printf(" (%u bad char%s)", badchars, + badchars != 1 ? "s" : ""); + putchar('\n'); + } + } + + if (udhl) { + printf("\nUDH:\n"); + msg_bits_hexdump(pdu + pdu_ptr + 1, udhl); + } + if (!ud_chars) + return(0); + putchar('\n'); + if (do_hexdump) { + if (dcs_distilled == 7) + msg_bits_hexdump(ud7 + udh_chars, ud_chars); + else + msg_bits_hexdump(pdu + pdu_ptr + udh_chars, ud_chars); + } else + puts(decode_buf); + return(0); +}
--- a/uptools/sms-pdu-decode/sms-pdu-decode.c Tue Feb 04 18:22:22 2020 +0000 +++ b/uptools/sms-pdu-decode/sms-pdu-decode.c Sat Feb 08 00:48:28 2020 +0000 @@ -6,384 +6,17 @@ #include <strings.h> #include <unistd.h> -char *infname; -FILE *inf; -int ascii_ext_mode, global_hexdump_mode, keep_raw_pdu; - -char input_line[1024]; -u_char pdu[176], first_octet; -unsigned pdu_length, pdu_ptr; -int dcs_distilled; - -handle_sca() -{ - unsigned sca_len; - char digits[21]; - - sca_len = pdu[0]; - pdu_ptr = 1; - if (!sca_len) - return(0); - if (sca_len < 2 || sca_len > 11) { - printf("Decode-Error: invalid SCA length\n"); - return(-1); - } - if (pdu_ptr + sca_len > pdu_length) { - printf("Decode-Error: SCA goes past PDU end\n"); - return(-1); - } - pdu_ptr += sca_len; - decode_address_digits(pdu + 2, digits, sc_addr_ndigits(pdu)); - printf("SCA: %s%s (type 0x%02X)\n", pdu[1] == 0x91 ? "+" : "", digits, - pdu[1]); - return(0); -} - -handle_first_octet() -{ - if (pdu_ptr >= pdu_length) { - printf("Decode-Error: end of PDU before FO\n"); - return(-1); - } - first_octet = pdu[pdu_ptr++]; - printf("First-Octet: 0x%02X\n", first_octet); - return(0); -} - -handle_mr() -{ - if (pdu_ptr >= pdu_length) { - printf("Decode-Error: end of PDU before MR\n"); - return(-1); - } - printf("MR: 0x%02X\n", pdu[pdu_ptr++]); - return(0); -} - -handle_user_addr(direction) - char *direction; -{ - unsigned addr_field_len, alpha_nsep; - char digits[21]; - u_char alpha_gsm7[11], alpha_decoded[23]; - - if (pdu_ptr >= pdu_length) { - printf("Decode-Error: end of PDU before %s address\n", - direction); - return(-1); - } - if (pdu[pdu_ptr] > 20) { - printf("Decode-Error: %s address > 20 digits\n", direction); - return(-1); - } - addr_field_len = ((pdu[pdu_ptr] + 1) >> 1) + 2; - if (pdu_ptr + addr_field_len > pdu_length) { - printf("Decode-Error: %s address goes past PDU end\n", - direction); - return(-1); - } - if (!pdu[pdu_ptr]) - printf("%s: empty-addr (type 0x%02X)\n", direction, - pdu[pdu_ptr+1]); - else if ((pdu[pdu_ptr+1] & 0x70) == 0x50 && - alpha_addr_valid(pdu[pdu_ptr], &alpha_nsep)) { - gsm7_unpack(pdu + pdu_ptr + 2, alpha_gsm7, alpha_nsep); - gsm7_to_ascii_or_ext(alpha_gsm7, alpha_nsep, alpha_decoded, - (unsigned *) 0, ascii_ext_mode, 0, - (unsigned *) 0); - printf("%s: \"%s\" (type 0x%02X)\n", direction, alpha_decoded, - pdu[pdu_ptr+1]); - } else { - decode_address_digits(pdu + pdu_ptr + 2, digits, pdu[pdu_ptr]); - printf("%s: %s%s (type 0x%02X)\n", direction, - pdu[pdu_ptr+1] == 0x91 ? "+" : "", digits, - pdu[pdu_ptr+1]); - } - pdu_ptr += addr_field_len; - return(0); -} - -handle_pid() -{ - if (pdu_ptr >= pdu_length) { - printf("Decode-Error: end of PDU before PID\n"); - return(-1); - } - printf("PID: 0x%02X\n", pdu[pdu_ptr++]); - return(0); -} - -handle_dcs() -{ - u_char dcs; - char *strtype; - - if (pdu_ptr >= pdu_length) { - printf("Decode-Error: end of PDU before DCS\n"); - return(-1); - } - dcs = pdu[pdu_ptr++]; - dcs_distilled = sms_dcs_classify(dcs); - switch (dcs_distilled) { - case 7: - strtype = "7-bit"; - break; - case 8: - strtype = "raw octets"; - break; - case 9: - strtype = "compressed"; - break; - case 16: - strtype = "UCS-2"; - break; - } - printf("DCS: 0x%02X (%s)\n", dcs, strtype); - return(0); -} - -handle_scts() -{ - char str[21]; - - if (pdu_ptr + 7 > pdu_length) { - printf("Decode-Error: end of PDU before SCTS\n"); - return(-1); - } - gsm_timestamp_decode(pdu + pdu_ptr, str); - printf("SC-Timestamp: %s\n", str); - pdu_ptr += 7; - return(0); -} - -handle_vp_abs() -{ - char str[21]; - - if (pdu_ptr + 7 > pdu_length) { - printf("Decode-Error: end of PDU before VP-abs\n"); - return(-1); - } - gsm_timestamp_decode(pdu + pdu_ptr, str); - printf("VP-Absolute: %s\n", str); - pdu_ptr += 7; - return(0); -} - -handle_vp_rel() -{ - unsigned vprel, hours, min; - - if (pdu_ptr >= pdu_length) { - printf("Decode-Error: end of PDU before VP-rel\n"); - return(-1); - } - vprel = pdu[pdu_ptr++]; - if (vprel <= 143) { - min = (vprel + 1) * 5; - goto hhmm; - } else if (vprel <= 167) { - min = (vprel - 143) * 30 + 12 * 60; - goto hhmm; - } else if (vprel <= 196) { - printf("VP-Relative: %u days\n", vprel - 166); - return(0); - } else { - printf("VP-Relative: %u weeks\n", vprel - 192); - return(0); - } +extern int ascii_ext_mode, global_hexdump_mode; +extern u_char pdu[176]; +extern unsigned pdu_length; -hhmm: hours = min / 60; - min %= 60; - printf("VP-Relative: "); - if (hours) - printf(" %u hour%s", hours, hours != 1 ? "s" : ""); - if (min) - printf(" %u min", min); - putchar('\n'); - return(0); -} - -handle_vp_enh() -{ - if (pdu_ptr + 7 > pdu_length) { - printf("Decode-Error: end of PDU before VP-enh\n"); - return(-1); - } - printf("VP-Enhanced: %02X %02X %02X %02X %02X %02X %02X\n", - pdu[pdu_ptr], pdu[pdu_ptr+1], pdu[pdu_ptr+2], pdu[pdu_ptr+3], - pdu[pdu_ptr+4], pdu[pdu_ptr+5], pdu[pdu_ptr+6]); - pdu_ptr += 7; - return(0); -} - -handle_vp() -{ - int rc; - - switch (first_octet & 0x18) { - case 0x00: - rc = 0; - break; - case 0x08: - rc = handle_vp_enh(); - break; - case 0x10: - rc = handle_vp_rel(); - break; - case 0x18: - rc = handle_vp_abs(); - break; - } - return(rc); -} - -process_pdu() -{ - unsigned udl, udl_octets; - unsigned udhl, udh_octets, udh_chars, ud_chars; - u_char ud7[160], decode_buf[321]; - int do_hexdump; - unsigned decoded_len, badchars; +static char *infname; +static FILE *inf; +static int keep_raw_pdu; - if (handle_sca() < 0) - return(-1); - if (handle_first_octet() < 0) - return(-1); - if (first_octet & 2) { - printf("Decode-Error: MTI not supported\n"); - return(-1); - } - if (first_octet & 1) { - if (handle_mr() < 0) - return(-1); - } - if (handle_user_addr(first_octet & 1 ? "To" : "From") < 0) - return(-1); - if (handle_pid() < 0) - return(-1); - if (handle_dcs() < 0) - return(-1); - if (first_octet & 1) { - if (handle_vp() < 0) - return(-1); - } else { - if (handle_scts() < 0) - return(-1); - } - if (pdu_ptr >= pdu_length) { - printf("Decode-Error: end of PDU before UDL\n"); - return(-1); - } - udl = pdu[pdu_ptr++]; - if (dcs_distilled == 7) { - if (udl > 160) { - printf("Decode-Error: UDL %u > 160\n", udl); - return(-1); - } - udl_octets = (udl * 7 + 7) / 8; - } else { - if (udl > 140) { - printf("Decode-Error: UDL %u > 140\n", udl); - return(-1); - } - udl_octets = udl; - } - if (pdu_length - pdu_ptr != udl_octets) { - printf("Decode-Error: UD length in PDU %u != expected %u\n", - pdu_length - pdu_ptr, udl_octets); - return(-1); - } - if (first_octet & 0x40) { - if (!udl) { - printf("Decode-Error: UDHI set with UDL=0\n"); - return(-1); - } - udhl = pdu[pdu_ptr]; - udh_octets = udhl + 1; - if (udh_octets > udl_octets) { - printf("Decode-Error: UDHL exceeds UDL\n"); - return(-1); - } - printf("UDH-Length: %u\n", udhl); - if (dcs_distilled == 7) - udh_chars = (udh_octets * 8 + 6) / 7; - else - udh_chars = udh_octets; - } else { - udhl = 0; - udh_octets = 0; - udh_chars = 0; - } - if (udh_chars >= udl) { - ud_chars = 0; - printf("Length: 0\n"); - } else { - ud_chars = udl - udh_chars; - if (dcs_distilled == 7) - gsm7_unpack(pdu + pdu_ptr, ud7, udl); - if (global_hexdump_mode) - do_hexdump = 1; - else switch (dcs_distilled) { - case 7: - do_hexdump = 0; - break; - case 8: - case 9: - do_hexdump = 1; - break; - case 16: - if (ud_chars & 1) - do_hexdump = 1; - else - do_hexdump = 0; - break; - } - if (do_hexdump) - printf("Length: %u (raw)\n", ud_chars); - else { - switch (dcs_distilled) { - case 7: - gsm7_to_ascii_or_ext(ud7 + udh_chars, ud_chars, - decode_buf, &decoded_len, - ascii_ext_mode, 1, - &badchars); - break; - case 16: - ucs2_to_ascii_or_ext(pdu + pdu_ptr + udh_chars, - ud_chars, - decode_buf, &decoded_len, - ascii_ext_mode, 1, - &badchars); - break; - } - printf("Length: %u", ud_chars); - if (decoded_len != ud_chars) - printf("->%u", decoded_len); - if (badchars) - printf(" (%u bad char%s)", badchars, - badchars != 1 ? "s" : ""); - putchar('\n'); - } - } +static char input_line[1024]; - if (udhl) { - printf("\nUDH:\n"); - msg_bits_hexdump(pdu + pdu_ptr + 1, udhl); - } - if (!ud_chars) - return(0); - putchar('\n'); - if (do_hexdump) { - if (dcs_distilled == 7) - msg_bits_hexdump(ud7 + udh_chars, ud_chars); - else - msg_bits_hexdump(pdu + pdu_ptr + udh_chars, ud_chars); - } else - puts(decode_buf); - return(0); -} - +static process_cmdline(argc, argv) char **argv; { @@ -412,6 +45,7 @@ infname = argv[optind]; } +static swallow_empty_line() { int c;