FreeCalypso > hg > fc-sim-tools
diff libutil/gsm7_pack.c @ 8:34bbb0585cab
libutil: import from previous fc-pcsc-tools version
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 14 Mar 2021 05:42:37 +0000 |
parents | |
children |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/libutil/gsm7_pack.c Sun Mar 14 05:42:37 2021 +0000 @@ -0,0 +1,22 @@ +/* + * 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; + } +}