util.c (1791B)
1 #include "util.h" 2 3 const char b64table[] = 4 "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/"; 5 6 static int b64_chunk_to_hex(char **hex, char *b64) 7 { 8 unsigned int val; 9 unsigned int sz; 10 int i; 11 12 if (strlen(b64) != 4) 13 return -1; 14 15 val = 0; 16 for (i = 0; i < 4; i++) { 17 int j = 0; 18 val <<= 6; 19 20 while (b64[i] != '=' && b64table[j] != b64[i]) 21 j++; 22 23 val += j; 24 } 25 26 sz = 6 - 2 * ((b64[2] == '=') + (b64[3] == '=')); 27 sz++; 28 29 *hex = (char *) malloc(sizeof(char) * sz); 30 snprintf(*hex, sz, "%0*x", sz - 1, val); 31 return 0; 32 } 33 34 int base64_to_hex(char **hex, char *b64) 35 { 36 unsigned int len; 37 int i; 38 39 len = (strlen(b64) * 3 / 4) + 2; 40 *hex = (char *) malloc(sizeof(char *) * len); 41 42 for (i = 0; i < strlen(b64)/4; i++) { 43 char b64_chunk[5]; 44 char *hex_chunk; 45 46 b64_chunk[4] = '\0'; 47 memcpy(b64_chunk, b64+4*i, 4); 48 b64_chunk_to_hex(&hex_chunk, b64_chunk); 49 strcat(*hex, hex_chunk); 50 } 51 } 52 53 int hex_to_base64(char **b64, char *hex) 54 { 55 int leftover_length; 56 int block_count; 57 int res_length; 58 int length; 59 char *res; 60 int i; 61 62 length = strlen(hex); 63 block_count = length / 6; 64 leftover_length = length % 6; 65 res_length = block_count * 4; 66 67 if (leftover_length%2 == 1) { 68 fprintf(stderr, "bad sequence length\n"); 69 return -1; 70 } 71 72 res = (char *) malloc(sizeof(char) * res_length + 2); 73 74 for (i = 0; i < block_count + (leftover_length != 0); i++) { 75 char block[6+1]; 76 int block_hex; 77 int end_ix; 78 int j; 79 80 end_ix = i < block_count ? 6 : leftover_length; 81 memcpy(block, hex+(6*i), end_ix); 82 block[end_ix] = '\0'; 83 84 block_hex = strtol(block, NULL, 16); 85 block_hex <<= 4 * (6 - end_ix); 86 87 for (j = 0; j < 4; j++) { 88 char b64; 89 90 b64 = b64table[(block_hex >> 6 * (3 - j)) & 0x3f]; 91 res[4 *i + j] = j <= end_ix / 2 ? b64 : '='; 92 } 93 } 94 95 *b64 = res; 96 return 0; 97 }