lib/minilib.c

   1 #include "console.h"
   2 #include <minilib.h>
   3
   4 void memcpy(void *dest, const void *src, int bytes)
   5 {
   6         char *cdest = dest;
   7         const char *csrc = src;
   8         while (bytes--)
   9                 *(cdest++) = *(csrc++);
  10 }
  11
  12 void memset(void *dest, int data, int bytes)
  13 {
  14         unsigned char *cdest = dest;
  15         while (bytes--)
  16                 *(cdest++) = (unsigned char)data;
  17 }
  18
  19 void memmove(void *dest, void *src, int bytes)
  20 {
  21         char * cdest = dest;
  22         char * csrc = src;
  23         if ((cdest > csrc) && (cdest <= (csrc + bytes)))
  24         {
  25                 /* do it backwards! */
  26                 cdest += bytes;
  27                 csrc += bytes;
  28                 while (bytes--)
  29                         *(--cdest) = *(--csrc);
  30         } else
  31                 while (bytes--)
  32                         *(cdest++) = *(csrc++);
  33 }
  34
  35 int memcmp (const char *a2, const char *a1, int bytes) {
  36         while (bytes--)
  37         {
  38                 if (*(a2++) != *(a1++))
  39                         return 1;
  40         }
  41         return 0;
  42 }
  43
  44 int strcmp (const char *a2, const char *a1) {
  45         while (1) {
  46                 if (*a2 != *a1) return 1;
  47                 if (*a2 == 0) return 0;
  48                 a1++;
  49                 a2++;
  50         }
  51 }
  52
  53 int strncmp (const char *a2, const char *a1, int n) {
  54         while (n--) {
  55                 if (*a2 != *a1) return 1;
  56                 if (*a2 == 0) return 0;
  57                 a1++;
  58                 a2++;
  59         }
  60         return 0;
  61 }
  62
  63 int strlen(const char *c)
  64 {
  65         int l = 0;
  66         while (*(c++))
  67                 l++;
  68         return l;
  69 }
  70
  71 void strcpy(char *a2, const char *a1)
  72 {
  73         do {
  74                 *(a2++) = *a1;
  75         } while (*(a1++));
  76 }
  77
  78 void puts(const char *c)
  79 {
  80         putbytes(c, strlen(c));
  81 }
  82
  83 static char hexarr[] = "0123456789ABCDEF";
  84 void tohex(char *s, unsigned long l)
  85 {
  86         int i;
  87         for (i = 0; i < 8; i++)
  88         {
  89                 s[i] = hexarr[l >> 28];
  90                 l <<= 4;
  91         }
  92 }
  93
  94 void puthex(unsigned long l)
  95 {
  96         char d[9];
  97         d[8] = 0;
  98         tohex(d, l);
  99         puts(d);
 100 }
 101
 102 unsigned short htons(unsigned short in)
 103 {
 104         return (in >> 8) | (in << 8);
 105 }
 106
 107 unsigned int htonl(unsigned int in)
 108 {
 109         return ((in & 0xff) << 24) |
 110                ((in & 0xff00) << 8) |
 111                ((in & 0xff0000UL) >> 8) |
 112                ((in & 0xff000000UL) >> 24);
 113 }