view uptools/libcoding/number_encode.c @ 702:36e6a1ff9608

lunadrv: rd and wr commands added
author Mychaela Falconia <falcon@freecalypso.org>
date Thu, 07 May 2020 02:40:13 +0000
parents 7154a231e4b5
children
line wrap: on
line source

/*
 * This library module implements the function that parses SMS destination
 * addresses given by the user and encodes them into the GSM 03.40
 * TP-Destination-Address structure.
 */

#include <sys/types.h>
#include <ctype.h>
#include <stdlib.h>

digit_char_to_gsm(ch)
{
	switch (ch) {
	case '0':
	case '1':
	case '2':
	case '3':
	case '4':
	case '5':
	case '6':
	case '7':
	case '8':
	case '9':
		return (ch - '0');
	case '*':
		return 0xA;
	case '#':
		return 0xB;
	case 'a':
	case 'b':
	case 'c':
		return (ch - 'a' + 0xC);
	case 'A':
	case 'B':
	case 'C':
		return (ch - 'A' + 0xC);
	}
	return (-1);
}

parse_and_encode_dest_addr(input, outbuf)
	char *input;
	u_char *outbuf;
{
	char *cp, *endp;
	int d;
	u_char digits[20];
	unsigned n;

	cp = input;
	if (*cp == '+') {
		outbuf[1] = 0x91;
		cp++;
	} else
		outbuf[1] = 0x81;
	if (digit_char_to_gsm(*cp) < 0)
		return(-1);
	n = 0;
	while ((d = digit_char_to_gsm(*cp)) >= 0) {
		cp++;
		if (n >= 20)
			return(-1);
		digits[n++] = d;
	}
	outbuf[0] = n;
	while (n < 20)
		digits[n++] = 0xF;
	if (*cp == ',') {
		cp++;
		if (!isdigit(*cp))
			return(-1);
		outbuf[1] = strtoul(cp, &endp, 0);
		if (*endp)
			return(-1);
	} else if (*cp)
		return(-1);
	for (n = 0; n < 10; n++)
		outbuf[2+n] = (digits[n*2+1] << 4) | digits[n*2];
	return(0);
}