136 lines
2.1 KiB
C
136 lines
2.1 KiB
C
/*
|
|
* Copyright (c) 2018 Intel Corporation
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
#include <stdarg.h>
|
|
|
|
/* Tiny, but not-as-primitive-as-it-looks implementation of something
|
|
* like s/n/printf(). Handles %d, %x, %c and %s only, no precision
|
|
* specifiers or type modifiers.
|
|
*/
|
|
|
|
struct _pfr {
|
|
char *buf;
|
|
int len;
|
|
int idx;
|
|
};
|
|
|
|
/* Set this function pointer to something that generates output */
|
|
static void (*z_putchar)(int c);
|
|
|
|
static void pc(struct _pfr *r, int c)
|
|
{
|
|
if (r->buf) {
|
|
if (r->idx <= r->len)
|
|
r->buf[r->idx] = c;
|
|
} else {
|
|
z_putchar(c);
|
|
}
|
|
r->idx++;
|
|
}
|
|
|
|
static void prdec(struct _pfr *r, int v)
|
|
{
|
|
if (v < 0) {
|
|
pc(r, '-');
|
|
v = -v;
|
|
}
|
|
|
|
char digs[11];
|
|
int i = 10;
|
|
|
|
digs[i--] = 0;
|
|
while (v || i == 9) {
|
|
digs[i--] = '0' + (v % 10);
|
|
v /= 10;
|
|
}
|
|
|
|
while (digs[++i])
|
|
pc(r, digs[i]);
|
|
}
|
|
|
|
static void endrec(struct _pfr *r)
|
|
{
|
|
if (r->buf && r->idx < r->len)
|
|
r->buf[r->idx] = 0;
|
|
}
|
|
|
|
static int vpf(struct _pfr *r, const char *f, va_list ap)
|
|
{
|
|
for (/**/; *f; f++) {
|
|
if (*f != '%') {
|
|
pc(r, *f);
|
|
continue;
|
|
}
|
|
|
|
switch (*(++f)) {
|
|
case '%':
|
|
pc(r, '%');
|
|
break;
|
|
case 'c':
|
|
pc(r, va_arg(ap, int));
|
|
break;
|
|
case 's': {
|
|
char *s = va_arg(ap, char *);
|
|
|
|
while (*s)
|
|
pc(r, *s++);
|
|
break;
|
|
}
|
|
case 'p':
|
|
pc(r, '0');
|
|
pc(r, 'x'); /* fall through... */
|
|
case 'x': {
|
|
int sig = 0;
|
|
unsigned int v = va_arg(ap, unsigned int);
|
|
|
|
for (int i = 7; i >= 0; i--) {
|
|
int d = (v >> (i*4)) & 0xf;
|
|
|
|
sig += !!d;
|
|
if (sig || i == 0)
|
|
pc(r, "0123456789abcdef"[d]);
|
|
}
|
|
break;
|
|
}
|
|
case 'd':
|
|
prdec(r, va_arg(ap, int));
|
|
break;
|
|
default:
|
|
pc(r, '%');
|
|
pc(r, *f);
|
|
}
|
|
}
|
|
endrec(r);
|
|
return r->idx;
|
|
}
|
|
|
|
#define CALL_VPF(rec) \
|
|
va_list ap; \
|
|
va_start(ap, f); \
|
|
int ret = vpf(&r, f, ap); \
|
|
va_end(ap); \
|
|
return ret
|
|
|
|
static inline int snprintf(char *buf, unsigned long len, const char *f, ...)
|
|
{
|
|
struct _pfr r = { .buf = buf, .len = len };
|
|
|
|
CALL_VPF(&r);
|
|
}
|
|
|
|
static inline int sprintf(char *buf, const char *f, ...)
|
|
{
|
|
struct _pfr r = { .buf = buf, .len = 0x7fffffff };
|
|
|
|
CALL_VPF(&r);
|
|
}
|
|
|
|
static inline int printf(const char *f, ...)
|
|
{
|
|
struct _pfr r = {0};
|
|
|
|
CALL_VPF(&r);
|
|
}
|