purr-c/extern/libbaseencode/base64.c

168 lines
4.9 KiB
C

#include <stdio.h>
#include <stdlib.h>
#include <inttypes.h>
#include <string.h>
#include <ctype.h>
#include "common.h"
static int is_valid_b64_input(const char *user_data, size_t data_len);
static int get_char_index(unsigned char c);
static const unsigned char b64_alphabet[] = "ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz0123456789+/";
char *
base64_encode(const unsigned char *user_data, size_t data_len, baseencode_error_t *err)
{
baseencode_error_t error;
check_input(user_data, data_len, MAX_ENCODE_INPUT_LEN, &error);
if (error != SUCCESS) {
*err = error;
if (error == EMPTY_STRING) {
return strdup("");
} else {
return NULL;
}
}
size_t user_data_chars = data_len;
size_t total_bits = user_data_chars * 8;
int num_of_equals = 0;
switch (total_bits % 24) {
case 8:
num_of_equals = 2;
break;
case 16:
num_of_equals = 1;
break;
default:
break;
}
size_t output_length = (user_data_chars * 8 + 4) / 6;
char *encoded_data = calloc(output_length + num_of_equals + 1, 1);
if (encoded_data == NULL) {
*err = MEMORY_ALLOCATION;
return NULL;
}
uint8_t first_octet, second_octet, third_octet;
for (int i = 0, j = 0, triple = 0; i < user_data_chars + 1;) {
first_octet = (uint8_t) (i < user_data_chars+1 ? user_data[i++] : 0);
second_octet = (uint8_t) (i < user_data_chars+1 ? user_data[i++] : 0);
third_octet = (uint8_t) (i < user_data_chars+1 ? user_data[i++] : 0);
triple = (first_octet << 0x10) + (second_octet << 0x08) + third_octet;
encoded_data[j++] = b64_alphabet[(triple >> 0x12) & 0x3F];
encoded_data[j++] = b64_alphabet[(triple >> 0x0C) & 0x3F];
encoded_data[j++] = b64_alphabet[(triple >> 0x06) & 0x3F];
encoded_data[j++] = b64_alphabet[(triple >> 0x00) & 0x3F];
}
for (int i = 0; i < num_of_equals; i++) {
encoded_data[output_length + i] = '=';
}
encoded_data[output_length + num_of_equals] = '\0';
*err = SUCCESS;
return encoded_data;
}
unsigned char *
base64_decode(const char *user_data_untrimmed, size_t data_len, baseencode_error_t *err, size_t *output_len)
{
baseencode_error_t error;
check_input((unsigned char *)user_data_untrimmed, data_len, MAX_DECODE_BASE64_INPUT_LEN, &error);
if (error != SUCCESS) {
*err = error;
if (error == EMPTY_STRING) {
return (unsigned char *) strdup("");
} else {
return NULL;
}
}
char *user_data = strdup(user_data_untrimmed);
data_len -= strip_char(user_data, ' ');
if (!is_valid_b64_input(user_data, data_len)) {
*err = INVALID_B64_DATA;
free(user_data);
return NULL;
}
size_t user_data_chars = 0;
for (int z = 0; z < data_len; z++) {
// As it's not known whether data_len is with or without the +1 for the null byte, a manual check is required.
if (user_data[z] != '=' && user_data[z] != '\0') {
user_data_chars += 1;
}
}
size_t output_length = data_len / 4 * 3;
unsigned char *decoded_data = calloc(output_length + 1, 1);
if (decoded_data == NULL) {
*err = MEMORY_ALLOCATION;
free(user_data);
return NULL;
}
uint8_t mask = 0, current_byte = 0;
int bits_left = 8;
for (int i = 0, j = 0; i < user_data_chars; i++) {
int char_index = get_char_index((unsigned char)user_data[i]);
if (bits_left > BITS_PER_B64_BLOCK) {
mask = (uint8_t) char_index << (bits_left - BITS_PER_B64_BLOCK);
current_byte = (uint8_t) (current_byte | mask);
bits_left -= BITS_PER_B64_BLOCK;
} else {
mask = (uint8_t) char_index >> (BITS_PER_B64_BLOCK - bits_left);
current_byte = (uint8_t) (current_byte | mask);
decoded_data[j++] = current_byte;
current_byte = (uint8_t) (char_index << (BITS_PER_BYTE - BITS_PER_B64_BLOCK + bits_left));
bits_left += BITS_PER_BYTE - BITS_PER_B64_BLOCK;
}
}
decoded_data[output_length] = '\0';
free(user_data);
*err = SUCCESS;
*output_len = output_length;
return decoded_data;
}
static int
is_valid_b64_input(const char *user_data, size_t data_len)
{
size_t found = 0, b64_alphabet_len = sizeof(b64_alphabet);
for (int i = 0; i < data_len; i++) {
for(int j = 0; j < b64_alphabet_len; j++) {
if(user_data[i] == b64_alphabet[j] || user_data[i] == '=') {
found++;
break;
}
}
}
if (found != data_len) {
return 0;
} else {
return 1;
}
}
static int
get_char_index(unsigned char c)
{
for (int i = 0; i < sizeof(b64_alphabet); i++) {
if (b64_alphabet[i] == c) {
return i;
}
}
return -1;
}