view uptools/libcoding/gsm7_pack.c @ 737:6d97866bad79

first round of documentation for DUART28C boot control addition
author Mychaela Falconia <falcon@freecalypso.org>
date Wed, 16 Sep 2020 06:10:39 +0000
parents 15120d15cab5
children
line wrap: on
line source

/*
 * This library module implements the function for packing septets into octets.
 */

#include <sys/types.h>

gsm7_pack(inbuf, outbuf, noctets)
	u_char *inbuf, *outbuf;
	unsigned noctets;
{
	u_char *ip = inbuf, *op = outbuf;
	unsigned n, c;

	for (n = 0; n < noctets; n++) {
		c = n % 7;
		*op++ = ((ip[1] << 7) | ip[0]) >> c;
		if (c == 6)
			ip += 2;
		else
			ip += 1;
	}
}