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$"); 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 (; len > 0 && *s1 == *s2 && *s1 != '\0'; len--, s1++, s2++) 72 ; 73 return (len == 0 ? 0 : (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 int 118 printf(const char *fmt, ...) 119 { 120 va_list ap; 121 const char *hex = "0123456789abcdef"; 122 char buf[32], *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++ = '0' + (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 return (0); 177 } 178