Line data    Source code

       1             : /*
       2             :  * Copyright (c) 2004-2005 Kungliga Tekniska Högskolan
       3             :  * (Royal Institute of Technology, Stockholm, Sweden).
       4             :  * All rights reserved.
       5             :  *
       6             :  * Redistribution and use in source and binary forms, with or without
       7             :  * modification, are permitted provided that the following conditions
       8             :  * are met:
       9             :  *
      10             :  * 1. Redistributions of source code must retain the above copyright
      11             :  *    notice, this list of conditions and the following disclaimer.
      12             :  *
      13             :  * 2. Redistributions in binary form must reproduce the above copyright
      14             :  *    notice, this list of conditions and the following disclaimer in the
      15             :  *    documentation and/or other materials provided with the distribution.
      16             :  *
      17             :  * 3. Neither the name of the Institute nor the names of its contributors
      18             :  *    may be used to endorse or promote products derived from this software
      19             :  *    without specific prior written permission.
      20             :  *
      21             :  * THIS SOFTWARE IS PROVIDED BY THE INSTITUTE AND CONTRIBUTORS ``AS IS'' AND
      22             :  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
      23             :  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
      24             :  * ARE DISCLAIMED.  IN NO EVENT SHALL THE INSTITUTE OR CONTRIBUTORS BE LIABLE
      25             :  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
      26             :  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
      27             :  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
      28             :  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
      29             :  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
      30             :  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
      31             :  * SUCH DAMAGE.
      32             :  */
      33             : 
      34             : 
      35             : #include <config.h>
      36             : #include "roken.h"
      37             : #include <ctype.h>
      38             : #include "hex.h"
      39             : 
      40             : static const char hexchar[16] = "0123456789ABCDEF";
      41             : 
      42             : static inline int
      43      334180 : pos(char c)
      44             : {
      45      334180 :     if (c >= '0' && c <= '9')
      46      198121 :         return c - '0';
      47      136059 :     if (c >= 'A' && c <= 'F')
      48      136059 :         return 10 + c - 'A';
      49           0 :     if (c >= 'a' && c <= 'f')
      50           0 :         return 10 + c - 'a';
      51           0 :     return -1;
      52             : }
      53             : 
      54             : ROKEN_LIB_FUNCTION ssize_t ROKEN_LIB_CALL
      55           0 : hex_encode(const void *data, size_t size, char **str)
      56             : {
      57           0 :     const unsigned char *q = data;
      58           0 :     size_t i;
      59           0 :     char *p;
      60             : 
      61           0 :     p = calloc(size + 1, 2);
      62           0 :     if (p == NULL) {
      63           0 :         *str = NULL;
      64           0 :         return -1;
      65             :     }
      66             : 
      67           0 :     for (i = 0; i < size; i++) {
      68           0 :         p[i * 2] = hexchar[(*q >> 4) & 0xf];
      69           0 :         p[i * 2 + 1] = hexchar[*q & 0xf];
      70           0 :         q++;
      71             :     }
      72           0 :     p[i * 2] = '\0';
      73           0 :     *str = p;
      74             : 
      75           0 :     return i * 2;
      76             : }
      77             : 
      78             : ROKEN_LIB_FUNCTION ssize_t ROKEN_LIB_CALL
      79        1302 : hex_decode(const char *str, void *data, size_t len)
      80             : {
      81          48 :     size_t l;
      82        1302 :     unsigned char *p = data;
      83          48 :     size_t i;
      84          48 :     int d;
      85             : 
      86        1302 :     l = strlen(str);
      87             : 
      88             :     /* check for overflow, same as (l+1)/2 but overflow safe */
      89        1302 :     if ((l/2) + (l&1) > len)
      90           0 :         return -1;
      91             : 
      92        1302 :     if (l & 1) {
      93           0 :         if ((d = pos(str[0])) == -1)
      94           0 :             return -1;
      95           0 :         p[0] = d;
      96           0 :         str++;
      97           0 :         p++;
      98             :     }
      99      168392 :     for (i = 0; i < l / 2; i++) {
     100      167090 :         if ((d = pos(str[i * 2])) == -1)
     101           0 :             return -1;
     102      167090 :         p[i] = d << 4;
     103      167090 :         if ((d = pos(str[(i * 2) + 1])) == -1)
     104           0 :             return -1;
     105      167090 :         p[i] |= d;
     106             :     }
     107        1302 :     return i + (l & 1);
     108             : }