kout.c

#include "kout.h"

int8_t kout_u8h(char *s, uint8_t x)
{
	uint8_t t;
	t = x >> 4;
	t += 6;
	t += (t & 0x10) ? 0x31 : 0x2A;
	*(s++) = t;
	t = x & 0xF;
	t += 6;
	t += (t & 0x10) ? 0x31 : 0x2A;
	*(s++) = t;
	*(s++) = 0;
	return 2;
}

int8_t kout_u16h(char *s, uint16_t x)
{
	kout_u8h(s, x >> 8);
	s += 2;
	kout_u8h(s, x & 0xFF);
	return 4;
}

int8_t kout_u32h(char *s, uint32_t x)
{
	kout_u8h(s, x >> 24);
	s += 2;
	kout_u8h(s, (x >> 16) & 0xFF);
	s += 2;
	kout_u8h(s, (x >> 8) & 0xFF);
	s += 2;
	kout_u8h(s, x & 0xFF);
	return 8;
}

typedef struct
{
	uint32_t quot;
	uint8_t rem;
} ltkrn_divmodu3210struc;

inline static ltkrn_divmodu3210struc ltkrn_divmodu3210(uint32_t n)
{
	uint32_t qq;
	ltkrn_divmodu3210struc r;
	r.quot = n >> 1;
	r.quot += r.quot >> 1;
	r.quot += r.quot >> 4;
	r.quot += r.quot >> 8;
	r.quot += r.quot >> 16;
	qq = r.quot;
	r.quot >>= 3;
	r.rem = (uint8_t)(n - ((r.quot << 1) + (qq & ~7ul)));
	if(r.rem > 9) {
		r.rem -= 10;
		r.quot++;
	}
	return r;
}

char * kout_u32d(char *s, uint32_t x)
{
	ltkrn_divmodu3210struc r;
	s += 11; 
	*--s = 0;
	do {
		r = ltkrn_divmodu3210(x);
		*--s = r.rem + 0x30;
		x = r.quot;
	} while (x != 0);
	return s;
}

int8_t kin_u32h(char *s, uint32_t *val)
{
	uint32_t t = 0;
	int8_t c, n = 0;
	do {
		c = *(s++);
		c -= 0x30;
		if(c & 0x80) break;
		if(c > 9) {
			c &= ~0x20;
			c -= 0x11;
			if(c & 0x80) break;
			if(c > 5) break;
			c+=0x0A;
		}
		t = (t << 4) + c;
		n++;
	} while (1);
	*val = t;
	return n;
}

int8_t kin_u32d(char *s, uint32_t *val)
{
	uint32_t t = 0;
	int8_t c, n = 0;
	do {
		c = *(s++);
		c -= 0x30;
		if(c & 0x80) break;
		if(c > 9) break;
		t += (t << 2);
		t = (t << 1) + c;
		n++;
	} while (1);
	*val = t;
	return n;
}

int8_t kin_u32(char *s, uint32_t *val)
{
	int8_t n = 0;
	if(( s[0] == '0') && ( (s[1] & ~0x20) == 'X')  ) {
		return kin_u32h(s + 2, val);
	} else {
		return kin_u32d(s, val);
	}
}

char *kin_next(char *s)
{
	while( *s <= 0x20 ) s++;
	return s;
}