#include <stdint.h>
#include <stddef.h>
#include <stdio.h>
#include <string.h>

#define MAX_BYTE 0xFF
#define BITS_PER_BYTE 8

static void encodeToUint16(uint16_t *num, uint8_t *buffer, size_t len);
static uint16_t decodeUint16(uint8_t *bytes, size_t len);
static void printEncodedBuffer(uint16_t *numToEncode, uint8_t *buffer, size_t len);
static void printDecodedBuffer(uint8_t *buffer, size_t len);

static void encodeToUint16(uint16_t *num, uint8_t *buffer, size_t len) {

    uint8_t bytePos = 0;
	
    for (int i = len; i >= 0; i--) {
        buffer[i] = (i == len) ? (*num & MAX_BYTE) : ((*num >> bytePos) & MAX_BYTE);
        bytePos += BITS_PER_BYTE;
    }
}

static uint16_t decodeUint16(uint8_t *bytes, size_t len) {
	
	 uint8_t bytePos = 0;
	 uint16_t num = 0;
	
	for (int i = len; i >= 0; i--) {
        num += (i == len) ? (bytes[i]) : (bytes[i] << bytePos);
        bytePos += BITS_PER_BYTE;
    }
		return num;
}

static void printEncodedBuffer(uint16_t *numToEncode, uint8_t *buffer, size_t len) {

	encodeToUint16(numToEncode, buffer, len -1);
	printf("\n Hex value after encoding is: " );
	for (int i = 0; i < len; i++) {
		if (i > 0) printf("-");
    	printf("%02X", buffer[i]);
	}
}

static void printDecodedBuffer(uint8_t *buffer, size_t len) {

	uint16_t decodedNum = decodeUint16(buffer, len -1);
	printf("\n Value after decoding back to integer is %u", decodedNum);
}

int main(void) {
	
	uint16_t numToEncode = 256;
	size_t bufferLen = sizeof(uint16_t);
	uint8_t buffer[bufferLen];
	memset(buffer, 0, sizeof(bufferLen));
	
	printf("\n Value prior to encoding is %u ", numToEncode);
	printEncodedBuffer(&numToEncode, buffer, bufferLen);
	printDecodedBuffer(buffer, bufferLen);
	
	return 0;
}
