//
// Created by xemon on 06.09.22.
//

#include <memory.h>
#include "AsciiStringAssmeblingUtils.h"

static const char ASCII_STRING_HEX_CHAR[] = "0123456789ABCDEF";

static uint8_t vAsciiStringDecimalIntToChar(uint8_t number_0_9) {
    number_0_9 = number_0_9 % 10; //cutoff digits more 1 (numbers between 0 and 9)
    return ('0' + number_0_9); //return char of number('0' is base number in ascii)
}

void vAsciiStringAdd(char *string, size_t *stringLen, char *addString, size_t addStringLen) {
    memcpy(string + (*stringLen), addString, addStringLen);
    *stringLen += addStringLen;
}

void vAsciiStringAddChar(char *string, size_t *stringLen, uint8_t singleChar) {
    string[*stringLen] = singleChar;
    ++(*stringLen);
}

void vAsciiStringInit(char *string, size_t *stringLen, size_t fullLen) {
    memset(string, 0, fullLen);
    *stringLen = 0;
}

void vAsciiStringClean(char *string, size_t *stringLen) {
    if (*stringLen == 0)return;
    memset(string, 0, *stringLen);
    *stringLen = 0;
}

void vAsciiStringAddDecimalInt(char *string, size_t *stringLen, uint8_t number, uint8_t digits) {
    for (uint8_t reverse_digit = 1; reverse_digit <= digits; ++reverse_digit) {
        string[*stringLen + digits - reverse_digit] = vAsciiStringDecimalIntToChar(number);
        number /= 10;
    }
    *stringLen += digits;
}

void vAsciiStringSpitChars(char *one, char *two) {
    char tmp;
    tmp = *one;
    *one = *two;
    *two = tmp;
}

void vAsciiStringAddDecimalIntWithLimit(char *string, size_t *stringLen, int64_t number, uint8_t digitsLimit) {

    if (number < 0) {
        *(string + (*stringLen)) = '-';
        ++(*stringLen);
        number = -number;
    }

    uint32_t cutoffNumber = 1;

    for (uint8_t scale = 0; scale < digitsLimit; ++scale) {
        cutoffNumber *= 10;
    }
    number = number % cutoffNumber;

    if (number == 0) {
        string[*stringLen] = '0';
        (*stringLen) += 1;
    }

    uint8_t digits = 0;

    for (; (digits < digitsLimit) && (number != 0); ++digits) {
        string[(*stringLen) + digits] = vAsciiStringDecimalIntToChar(number % 10);
        number /= 10;
    }

    uint8_t reverses = digits / 2;

    for (uint8_t reverse_digit = 0; reverse_digit < reverses; ++reverse_digit) {
        vAsciiStringSpitChars(string + *stringLen + reverse_digit, string + *stringLen + digits - 1 - reverse_digit);
    }

    *stringLen += digits;
}

void vAsciiStringAddByteAsHex(char *str, size_t *stringLen, uint8_t number) {
    str[*stringLen + 0] = ASCII_STRING_HEX_CHAR[(number >> 4) & 0xF];
    str[*stringLen + 1] = ASCII_STRING_HEX_CHAR[(number & 0xF)];
    *stringLen += 2;
}

void vAsciiStringAddBytesAsHex(char *str, size_t *stringLen, uint8_t *bytesData, size_t bytesCount) {
    uint8_t *end = bytesData + bytesCount;
    while (end > bytesData) {
        vAsciiStringAddByteAsHex(str, stringLen, *bytesData);
        ++bytesData;
    }
}