serial.cpp

#include <stdio.h>
#include <stdlib.h>
#include "serial.hpp"

void write64(FILE *out, unsigned long long v) {
	// Big-endian so memcmp() sorts numerically
	for (ssize_t i = 64 - 8; i >= 0; i -= 8) {
		if (putc((v >> i) & 0xFF, out) == EOF) {
			perror("Write data");
			exit(EXIT_FAILURE);
		}
	}
}

void write64(unsigned char **out, unsigned long long v) {
	// Big-endian so memcmp() sorts numerically
	for (ssize_t i = 64 - 8; i >= 0; i -= 8) {
		**out = (v >> i) & 0xFF;
		(*out)++;
	}
}

void write32(FILE *out, unsigned long long v) {
	// Big-endian so memcmp() sorts numerically
	for (ssize_t i = 32 - 8; i >= 0; i -= 8) {
		if (putc((v >> i) & 0xFF, out) == EOF) {
			perror("Write data");
			exit(EXIT_FAILURE);
		}
	}
}

void write32(unsigned char **out, unsigned long long v) {
	// Big-endian so memcmp() sorts numerically
	for (ssize_t i = 32 - 8; i >= 0; i -= 8) {
		**out = (v >> i) & 0xFF;
		(*out)++;
	}
}

unsigned long long read64(unsigned char *c) {
	unsigned long long out = 0;

	for (ssize_t i = 0; i < 8; i++) {
		out = (out << 8) | c[i];
	}

	return out;
}

unsigned long long read32(unsigned char *c) {
	unsigned long long out = 0;

	for (ssize_t i = 0; i < 4; i++) {
		out = (out << 8) | c[i];
	}

	return out;
}