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$");
  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 void
 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 }