shithub: scc

ref: d68e26e79e47319e2066434c8d4e18c7a653159a
dir: /lib/scc/lunpack.c/

#include <stdarg.h>

#include "../../inc/scc.h"

int
lunpack(unsigned char *src, char *fmt, ...)
{
	unsigned char *bp, *cp;
	unsigned short *sp;
	unsigned s;
	unsigned long *lp, l;
	unsigned long long *qp, q;
	va_list va;

	bp = src;
	va_start(va, fmt);
	while (*fmt) {
		switch (*fmt++) {
		case 'c':
			cp = va_arg(va, unsigned char *);
			*cp = *bp++;
			break;
		case 's':
			sp = va_arg(va, unsigned short *);
			s =  (unsigned) *bp++ << 8;
			s |= (unsigned) *bp++;
			*sp = s;
			break;
		case 'l':
			lp = va_arg(va, unsigned long *);
			l =  (unsigned long) *bp++ << 24;
			l |= (unsigned long) *bp++ << 16;
			l |= (unsigned long) *bp++ << 8;
			l |= (unsigned long) *bp++;
			*lp = l;
			break;
		case 'q':
			qp = va_arg(va, unsigned long long *);
			q =  (unsigned long) *bp++ << 56;
			q |= (unsigned long) *bp++ << 48;
			q |= (unsigned long) *bp++ << 40;
			q |= (unsigned long) *bp++ << 32;
			q |= (unsigned long) *bp++ << 24;
			q |= (unsigned long) *bp++ << 16;
			q |= (unsigned long) *bp++ << 8;
			q |= (unsigned long) *bp++;
			*qp = q;
			break;
		default:
			va_end(va);
			return -1;
		}
	}
	va_end(va);

	return bp - src;
}