lib/utils.c

   1 /*
   2     utils.c -- gathering of some stupid small functions
   3     Copyright (C) 1999-2005 Ivo Timmermans
   4                   2000-2009 Guus Sliepen <guus@tinc-vpn.org>
   5
   6     This program is free software; you can redistribute it and/or modify
   7     it under the terms of the GNU General Public License as published by
   8     the Free Software Foundation; either version 2 of the License, or
   9     (at your option) any later version.
  10
  11     This program is distributed in the hope that it will be useful,
  12     but WITHOUT ANY WARRANTY; without even the implied warranty of
  13     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14     GNU General Public License for more details.
  15
  16     You should have received a copy of the GNU General Public License along
  17     with this program; if not, write to the Free Software Foundation, Inc.,
  18     51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  19 */
  20
  21 #include "system.h"
  22
  23 #include "../src/logger.h"
  24 #include "utils.h"
  25
  26 #ifdef ENABLE_TRACING
  27 volatile int (cp_line[]) = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0};
  28 volatile char (*cp_file[]) = {"?", "?", "?", "?", "?", "?", "?", "?", "?", "?", "?", "?", "?", "?", "?", "?"};
  29 volatile int cp_index = 0;
  30 #endif
  31
  32 const char hexadecimals[] = "0123456789ABCDEF";
  33
  34 int charhex2bin(char c) {
  35         if(isdigit(c))
  36                 return c - '0';
  37         else
  38                 return toupper(c) - 'A' + 10;
  39 }
  40
  41
  42 void hex2bin(char *src, char *dst, int length) {
  43         int i;
  44         for(i = 0; i < length; i++)
  45                 dst[i] = charhex2bin(src[i * 2]) * 16 + charhex2bin(src[i * 2 + 1]);
  46 }
  47
  48 void bin2hex(char *src, char *dst, int length) {
  49         int i;
  50         for(i = length - 1; i >= 0; i--) {
  51                 dst[i * 2 + 1] = hexadecimals[(unsigned char) src[i] & 15];
  52                 dst[i * 2] = hexadecimals[(unsigned char) src[i] >> 4];
  53         }
  54 }
  55
  56 #ifdef ENABLE_TRACING
  57 void cp_trace() {
  58         logger(LOG_DEBUG, "Checkpoint trace: %s:%d <- %s:%d <- %s:%d <- %s:%d <- %s:%d <- %s:%d <- %s:%d <- %s:%d <- %s:%d <- %s:%d <- %s:%d <- %s:%d <- %s:%d <- %s:%d <- %s:%d <- %s:%d...",
  59                    cp_file[(cp_index + 15) % 16], cp_line[(cp_index + 15) % 16],
  60                    cp_file[(cp_index + 14) % 16], cp_line[(cp_index + 14) % 16],
  61                    cp_file[(cp_index + 13) % 16], cp_line[(cp_index + 13) % 16],
  62                    cp_file[(cp_index + 12) % 16], cp_line[(cp_index + 12) % 16],
  63                    cp_file[(cp_index + 11) % 16], cp_line[(cp_index + 11) % 16],
  64                    cp_file[(cp_index + 10) % 16], cp_line[(cp_index + 10) % 16],
  65                    cp_file[(cp_index + 9) % 16], cp_line[(cp_index + 9) % 16],
  66                    cp_file[(cp_index + 8) % 16], cp_line[(cp_index + 8) % 16],
  67                    cp_file[(cp_index + 7) % 16], cp_line[(cp_index + 7) % 16],
  68                    cp_file[(cp_index + 6) % 16], cp_line[(cp_index + 6) % 16],
  69                    cp_file[(cp_index + 5) % 16], cp_line[(cp_index + 5) % 16],
  70                    cp_file[(cp_index + 4) % 16], cp_line[(cp_index + 4) % 16],
  71                    cp_file[(cp_index + 3) % 16], cp_line[(cp_index + 3) % 16],
  72                    cp_file[(cp_index + 2) % 16], cp_line[(cp_index + 2) % 16],
  73                    cp_file[(cp_index + 1) % 16], cp_line[(cp_index + 1) % 16],
  74                    cp_file[cp_index], cp_line[cp_index]
  75                 );
  76 }
  77 #endif
  78
  79 #if defined(HAVE_MINGW) || defined(HAVE_CYGWIN)
  80 #ifdef HAVE_CYGWIN
  81 #include <w32api/windows.h>
  82 #endif
  83
  84 const char *winerror(int err) {
  85         static char buf[1024], *newline;
  86
  87         if (!FormatMessage(FORMAT_MESSAGE_FROM_SYSTEM | FORMAT_MESSAGE_IGNORE_INSERTS,
  88                 NULL, err, MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT), buf, sizeof(buf), NULL)) {
  89                 strncpy(buf, _("(unable to format errormessage)"), sizeof(buf));
  90         };
  91
  92         if((newline = strchr(buf, '\r')))
  93                 *newline = '\0';
  94
  95         return buf;
  96 }
  97 #endif
  98
  99 unsigned int bitfield_to_int(void *bitfield, size_t size) {
 100         unsigned int value = 0;
 101         if(size > sizeof value)
 102                 size = sizeof value;
 103         memcpy(&value, bitfield, size);
 104         return value;
 105 }