FreeBSD/Linux Kernel Cross Reference
sys/boot/common/util.c
1 /*-
2 * Copyright (c) 1998 Robert Nordier
3 * Copyright (c) 2010 Pawel Jakub Dawidek <pjd@FreeBSD.org>
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms are freely
7 * permitted provided that the above copyright notice and this
8 * paragraph and the following disclaimer are duplicated in all
9 * such forms.
10 *
11 * This software is provided "AS IS" and without any express or
12 * implied warranties, including, without limitation, the implied
13 * warranties of merchantability and fitness for a particular
14 * purpose.
15 */
16
17 #include <sys/cdefs.h>
18 __FBSDID("$FreeBSD: releng/8.2/sys/boot/common/util.c 213994 2010-10-17 20:10:00Z pjd $");
19
20 #include <sys/param.h>
21
22 #include <stdarg.h>
23
24 #include "cons.h"
25 #include "util.h"
26
27 void
28 memcpy(void *dst, const void *src, int len)
29 {
30 const char *s = src;
31 char *d = dst;
32
33 while (len--)
34 *d++ = *s++;
35 }
36
37 void
38 memset(void *b, int c, size_t len)
39 {
40 char *bp = b;
41
42 while (len--)
43 *bp++ = (unsigned char)c;
44 }
45
46 int
47 memcmp(const void *b1, const void *b2, size_t len)
48 {
49 const unsigned char *p1, *p2;
50
51 for (p1 = b1, p2 = b2; len > 0; len--, p1++, p2++) {
52 if (*p1 != *p2)
53 return ((*p1) - (*p2));
54 }
55 return (0);
56 }
57
58 int
59 strcmp(const char *s1, const char *s2)
60 {
61
62 for (; *s1 == *s2 && *s1 != '\0'; s1++, s2++)
63 ;
64 return ((unsigned char)*s1 - (unsigned char)*s2);
65 }
66
67 int
68 strncmp(const char *s1, const char *s2, size_t len)
69 {
70
71 for (; *s1 == *s2 && *s1 != '\0' && len > 0; len--, s1++, s2++)
72 ;
73 return ((unsigned char)*s1 - (unsigned char)*s2);
74 }
75
76 void
77 strcpy(char *dst, const char *src)
78 {
79
80 while (*src != '\0')
81 *dst++ = *src++;
82 *dst = '\0';
83 }
84
85 void
86 strcat(char *dst, const char *src)
87 {
88
89 while (*dst != '\0')
90 dst++;
91 while (*src != '\0')
92 *dst++ = *src++;
93 *dst = '\0';
94 }
95
96 char *
97 strchr(const char *s, char ch)
98 {
99
100 for (; *s != '\0'; s++) {
101 if (*s == ch)
102 return ((char *)(uintptr_t)(const void *)s);
103 }
104 return (NULL);
105 }
106
107 size_t
108 strlen(const char *s)
109 {
110 size_t len = 0;
111
112 while (*s++ != '\0')
113 len++;
114 return (len);
115 }
116
117 void
118 printf(const char *fmt, ...)
119 {
120 va_list ap;
121 const char *hex = "0123456789abcdef";
122 char buf[10], *s;
123 unsigned long long u;
124 int c, l;
125
126 va_start(ap, fmt);
127 while ((c = *fmt++) != '\0') {
128 if (c != '%') {
129 putchar(c);
130 continue;
131 }
132 l = 0;
133 nextfmt:
134 c = *fmt++;
135 switch (c) {
136 case 'l':
137 l++;
138 goto nextfmt;
139 case 'c':
140 putchar(va_arg(ap, int));
141 break;
142 case 's':
143 for (s = va_arg(ap, char *); *s != '\0'; s++)
144 putchar(*s);
145 break;
146 case 'd': /* A lie, always prints unsigned */
147 case 'u':
148 case 'x':
149 switch (l) {
150 case 2:
151 u = va_arg(ap, unsigned long long);
152 break;
153 case 1:
154 u = va_arg(ap, unsigned long);
155 break;
156 default:
157 u = va_arg(ap, unsigned int);
158 break;
159 }
160 s = buf;
161 if (c == 'd' || c == 'u') {
162 do
163 *s++ = '' + (u % 10U);
164 while (u /= 10);
165 } else {
166 do
167 *s++ = hex[u & 0xfu];
168 while (u >>= 4);
169 }
170 while (--s >= buf)
171 putchar(*s);
172 break;
173 }
174 }
175 va_end(ap);
176 }
Cache object: ae3ba92fbe65cdc429391de5fded9ef7
|