src/fmt.c


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
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87

#include "fmt.h"

/**
  * @file fmt.c
  * @authors djb, feh
  * @ref qmail
  * @brief formating differnt inputs format for output printing
  */

unsigned int fmt_str(char *s,const char *t)
{
  unsigned int len;
  char ch;
  len = 0;
  if (s) { while ((ch = t[len])) s[len++] = ch; }
  else while (t[len]) len++;
  return len;
}

unsigned int fmt_strn(char *s,const char *t,unsigned int n)
{
  unsigned int len;
  char ch;
  len = 0;
  if (s) { while (n-- && (ch = t[len])) s[len++] = ch; }
  else while (n-- && t[len]) len++;
  return len;
}

unsigned int fmt_uint(char *s,unsigned int u)
{
  unsigned long l; l = u; return fmt_ulong(s,l);
}

unsigned int fmt_uint0(char *s,unsigned int u,unsigned int n)
{
  unsigned int len;
  len = fmt_uint(FMT_LEN,u);
  while (len < n) { if (s) *s++ = '0'; ++len; }
  if (s) fmt_uint(s,u);
  return len;
}

unsigned int fmt_ulong(char *s,unsigned long u)
{
  unsigned int len; 
  unsigned long q;
  len = 1; q = u;
  while (q > 9) { ++len; q /= 10; }
  if (s) {
    s += len;
    do { *--s = '0' + (u % 10); u /= 10; } while(u); /* handles u == 0 */
  }
  return len;
}

unsigned int fmt_xlong(char *s,unsigned long u)
{
  unsigned int len; 
  unsigned long q;
  len = 1; q = u;
  while (q > 15) { ++len; q /= 16; }
  if (s) {
    s += len;
    do { *--s = tohex(u % 16); u /= 16; } while(u); /* handles u == 0 */
  }
  return len;
}

char tohex(char num) {
  if (num < 10)
    return num + '0';
  else if (num < 16)
    return num - 10 + 'a';
  else
    return -1;
}

int fromhex(unsigned char c) {
  if (c >= '0' && c <= '9')
    return c-'0';
  else if (c >= 'A' && c <= 'F')
    return c -'A' + 10;
  else if (c >= 'a' && c <= 'f')
    return c - 'a' + 10;
  return -1;
}