| 2 |
theseven |
1 |
/***************************************************************************
|
|
|
2 |
* __________ __ ___.
|
|
|
3 |
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
|
4 |
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
|
5 |
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
|
6 |
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
|
7 |
* \/ \/ \/ \/ \/
|
|
|
8 |
* $Id$
|
|
|
9 |
*
|
|
|
10 |
* Copyright (C) 2002 by Gary Czvitkovicz
|
|
|
11 |
*
|
|
|
12 |
* This program is free software; you can redistribute it and/or
|
|
|
13 |
* modify it under the terms of the GNU General Public License
|
|
|
14 |
* as published by the Free Software Foundation; either version 2
|
|
|
15 |
* of the License, or (at your option) any later version.
|
|
|
16 |
*
|
|
|
17 |
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
|
|
18 |
* KIND, either express or implied.
|
|
|
19 |
*
|
|
|
20 |
****************************************************************************/
|
|
|
21 |
|
|
|
22 |
/*
|
|
|
23 |
* Minimal printf and snprintf formatting functions
|
|
|
24 |
*
|
|
|
25 |
* These support %c %s %d and %x
|
|
|
26 |
* Field width and zero-padding flag only
|
|
|
27 |
*/
|
|
|
28 |
|
|
|
29 |
#include "global.h"
|
|
|
30 |
#include <stdio.h>
|
|
|
31 |
#include <stdarg.h>
|
|
|
32 |
#include <stdbool.h>
|
|
|
33 |
#include <limits.h>
|
|
|
34 |
#include "format.h"
|
|
|
35 |
|
|
|
36 |
|
|
|
37 |
struct for_snprintf {
|
|
|
38 |
unsigned char *ptr; /* where to store it */
|
|
|
39 |
size_t bytes; /* amount already stored */
|
|
|
40 |
size_t max; /* max amount to store */
|
|
|
41 |
};
|
|
|
42 |
|
|
|
43 |
static int sprfunc(void *ptr, unsigned char letter)
|
|
|
44 |
{
|
|
|
45 |
struct for_snprintf *pr = (struct for_snprintf *)ptr;
|
|
|
46 |
if(pr->bytes < pr->max) {
|
|
|
47 |
*pr->ptr = letter;
|
|
|
48 |
pr->ptr++;
|
|
|
49 |
pr->bytes++;
|
|
|
50 |
return true;
|
|
|
51 |
}
|
|
|
52 |
return false; /* filled buffer */
|
|
|
53 |
}
|
|
|
54 |
|
|
|
55 |
|
|
|
56 |
int snprintf(char *buf, size_t size, const char *fmt, ...)
|
|
|
57 |
{
|
|
|
58 |
bool ok;
|
|
|
59 |
va_list ap;
|
|
|
60 |
struct for_snprintf pr;
|
|
|
61 |
|
|
|
62 |
pr.ptr = (unsigned char *)buf;
|
|
|
63 |
pr.bytes = 0;
|
|
|
64 |
pr.max = size;
|
|
|
65 |
|
|
|
66 |
va_start(ap, fmt);
|
|
|
67 |
ok = format(sprfunc, &pr, fmt, ap);
|
|
|
68 |
va_end(ap);
|
|
|
69 |
|
|
|
70 |
/* make sure it ends with a trailing zero */
|
|
|
71 |
pr.ptr[(pr.bytes < pr.max) ? 0 : -1] = '\0';
|
|
|
72 |
|
|
|
73 |
return pr.bytes;
|
|
|
74 |
}
|
|
|
75 |
|
|
|
76 |
int vsnprintf(char *buf, size_t size, const char *fmt, va_list ap)
|
|
|
77 |
{
|
|
|
78 |
bool ok;
|
|
|
79 |
struct for_snprintf pr;
|
|
|
80 |
|
|
|
81 |
pr.ptr = (unsigned char *)buf;
|
|
|
82 |
pr.bytes = 0;
|
|
|
83 |
pr.max = size;
|
|
|
84 |
|
|
|
85 |
ok = format(sprfunc, &pr, fmt, ap);
|
|
|
86 |
|
|
|
87 |
/* make sure it ends with a trailing zero */
|
|
|
88 |
pr.ptr[(pr.bytes < pr.max) ? 0 : -1] = '\0';
|
|
|
89 |
|
|
|
90 |
return pr.bytes;
|
|
|
91 |
}
|