view uptools/libcoding/gsm7_unpack.c @ 437:2cd705c8116e

loadtools: Mot C155 turns out to have the same flash partition quirks as the flash chip on TI's D-Sample c155.config changed to use the fixed 28f640w30b config instead of CFI, and a bit of C code in fc-loadtool had to be changed too so that flash erase-program-boot still works.
author Mychaela Falconia <falcon@freecalypso.org>
date Tue, 06 Nov 2018 16:02:23 +0000
parents d29b45c4c8db
children
line wrap: on
line source

/*
 * This library module implements unpacking of GSM 7-bit data
 * from packed octets.
 */

#include <sys/types.h>

static u_char shift[8] = {0, 7, 6, 5, 4, 3, 2, 1};

gsm7_unpack(inbuf, outbuf, nseptets)
	u_char *inbuf, *outbuf;
	unsigned nseptets;
{
	u_char *inp = inbuf, *outp = outbuf;
	unsigned n;

	for (n = 0; n < nseptets; n++) {
		*outp++ = (((inp[1] << 8) | inp[0]) >> shift[n&7]) & 0x7F;
		if (n & 7)
			inp++;
	}
}