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      227920 : pos(char c)
      44             : {
      45      227920 :     if (c >= '0' && c <= '9')
      46      135124 :         return c - '0';
      47       92796 :     if (c >= 'A' && c <= 'F')
      48       92796 :         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             :     size_t i;
      59             :     char *p;
      60             : 
      61             :     /* check for overflow */
      62           0 :     if (size * 2 < size) {
      63           0 :         *str = NULL;
      64           0 :         return -1;
      65             :     }
      66             : 
      67           0 :     p = malloc(size * 2 + 1);
      68           0 :     if (p == NULL) {
      69           0 :         *str = NULL;
      70           0 :         return -1;
      71             :     }
      72             : 
      73           0 :     for (i = 0; i < size; i++) {
      74           0 :         p[i * 2] = hexchar[(*q >> 4) & 0xf];
      75           0 :         p[i * 2 + 1] = hexchar[*q & 0xf];
      76           0 :         q++;
      77             :     }
      78           0 :     p[i * 2] = '\0';
      79           0 :     *str = p;
      80             : 
      81           0 :     return i * 2;
      82             : }
      83             : 
      84             : ROKEN_LIB_FUNCTION ssize_t ROKEN_LIB_CALL
      85         888 : hex_decode(const char *str, void *data, size_t len)
      86             : {
      87             :     size_t l;
      88         888 :     unsigned char *p = data;
      89             :     size_t i;
      90             :     int d;
      91             : 
      92         888 :     l = strlen(str);
      93             : 
      94             :     /* check for overflow, same as (l+1)/2 but overflow safe */
      95         888 :     if ((l/2) + (l&1) > len)
      96           0 :         return -1;
      97             : 
      98         888 :     if (l & 1) {
      99           0 :         if ((d = pos(str[0])) == -1)
     100           0 :             return -1;
     101           0 :         p[0] = d;
     102           0 :         str++;
     103           0 :         p++;
     104             :     }
     105      114848 :     for (i = 0; i < l / 2; i++) {
     106      113960 :         if ((d = pos(str[i * 2])) == -1)
     107           0 :             return -1;
     108      113960 :         p[i] = d << 4;
     109      113960 :         if ((d = pos(str[(i * 2) + 1])) == -1)
     110           0 :             return -1;
     111      113960 :         p[i] |= d;
     112             :     }
     113         888 :     return i + (l & 1);
     114             : }