aboutsummaryrefslogtreecommitdiffstats
path: root/dl_pack_ascii.c
blob: fe8f08d750138891b5756cebe2fcc9d549f657f4 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
/* 
 * Copyright 1996-2002 - Karl R. Hakimian and David Fries
 *
 * This file is part of datalink.
 *
 * Datalink is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * Datalink is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with datalink (see COPYING); if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 */

#include "datalink.h"

int dl_pack_ascii(unsigned char *to, unsigned char *from)
{
	int c;
	int p = 0;
	int o = 0;

	while (*from)
	{

		if (o == 0)
		{
			to[p] = dl_pack_char(*from);
			o = 6;
			from++;
			continue;
		}

		c = dl_pack_char(*from);
		to[p] |= c << o;
		to[++p] = c >> (8 - o);
		o = (o + 6) % 8;
		from++;
	}

	if (o)
	{
		to[p] |= 0x3f << o;
		to[++p] = 0x3f >> (8 - o);
		o = (o + 6) % 8;
		if (o)
			p++;
	} else
		to[p++] = 0x3f;

	return (p);
}