wibo/strutil.cpp

#include "strutil.h"
#include "common.h"
#include <cstdint>
#include <sstream>
#include <string>
#include <vector>

size_t wstrlen(const uint16_t *str) {
	if (!str)
		return 0;

	size_t len = 0;
	while (str[len] != 0)
		++len;
	return len;
}

size_t wstrnlen(const uint16_t *str, size_t numberOfElements) {
	if (!str)
		return 0;
	size_t len = 0;
	while (len < numberOfElements && str[len] != 0)
		++len;
	return len;
}

int wstrncmp(const uint16_t *string1, const uint16_t *string2, size_t count) {
	const uint16_t *ptr1 = string1;
	const uint16_t *ptr2 = string2;
	for (size_t i = 0; i < count; i++) {
		uint16_t c1 = *ptr1++;
		uint16_t c2 = *ptr2++;
		if (c1 != c2) {
			return (c1 > c2) ? 1 : -1;
		}
	}
	return 0;
}

const uint16_t *wstrstr(const uint16_t *dest, const uint16_t *src) {
	if (!*src)
		return dest;

	for (; *dest != 0; dest++) {
		const uint16_t *d = dest;
		const uint16_t *s = src;

		while (*d != 0 && *s != 0 && *d == *s) {
			d++;
			s++;
		}

		if (*s == 0) {
			return dest;
		}
	}

	return nullptr;
}

uint16_t *wstrchr(const uint16_t *str, uint16_t c) {
	if (!str)
		return nullptr;
	for (; *str != 0; str++) {
		if (*str == c) {
			return (uint16_t *)str;
		}
	}
	// If searching for '\0', return pointer to terminator
	if (c == 0) {
		return (uint16_t *)str;
	}
	return nullptr;
}

uint16_t *wstrrchr(const uint16_t *str, uint16_t c) {
	if (!str)
		return nullptr;
	const uint16_t *last = nullptr;
	const uint16_t *it = str;
	for (; *it != 0; ++it) {
		if (*it == c) {
			last = it;
		}
	}
	if (c == 0)
		return (uint16_t *)it;
	return (uint16_t *)last;
}

uint16_t *wstrcat(uint16_t *dest, const uint16_t *src) {
	uint16_t *d = dest;
	while (*d)
		d++;
	while ((*d++ = *src++) != 0)
		;
	return dest;
}

uint16_t *wstrncat(uint16_t *dest, const uint16_t *src, size_t count) {
	uint16_t *d = dest;
	while (*d)
		d++;
	for (size_t i = 0; i < count && src[i] != 0; i++) {
		*d++ = src[i];
	}
	*d = 0;
	return dest;
}

uint16_t *wstrcpy(uint16_t *dest, const uint16_t *src) {
	uint16_t *d = dest;
	while ((*d++ = *src++) != 0)
		;
	return dest;
}

size_t wstrncpy(uint16_t *dst, const uint16_t *src, size_t n) {
	if (!dst || !src || n == 0)
		return 0;
	size_t i = 0;
	for (; i < n && src[i] != 0; ++i) {
		dst[i] = src[i];
	}
	for (size_t j = i; j < n; ++j) {
		dst[j] = 0;
	}
	return i;
}

std::string wideStringToString(const uint16_t *src, int len) {
	if (!src)
		return {};

	size_t count;
	if (len >= 0) {
		count = static_cast<size_t>(len);
	} else {
		count = wstrlen(src);
	}

#ifndef NDEBUG
	std::stringstream hexDump;
	hexDump << std::hex;
	bool sawWide = false;
#endif

	std::string result(count, '\0');
	for (size_t i = 0; i < count; ++i) {
		uint16_t value = src[i];
		if (i > 0)
			hexDump << ' ';
		hexDump << "0x" << value;
		if (value > 0xFF)
			sawWide = true;
		result[i] = static_cast<char>(value & 0xFF);
	}

#ifndef NDEBUG
	if (sawWide) {
		size_t loggedLength = (len >= 0) ? count : wstrlen(src);
		DEBUG_LOG("wideString (%zu): %s\n", loggedLength, hexDump.str().c_str());
	}
#endif

	return result;
}

std::vector<uint16_t> stringToWideString(const char *src) {
	if (!src)
		return std::vector<uint16_t>{0};
	size_t len = strlen(src);
	std::vector<uint16_t> res(len + 1);
	for (size_t i = 0; i < res.size(); i++) {
		res[i] = static_cast<uint16_t>(src[i] & 0xFF);
	}
	res[len] = 0; // NUL terminate
	return res;
}

long wstrtol(const uint16_t *string, uint16_t **end_ptr, int base) {
	if (!string) {
		if (end_ptr)
			*end_ptr = nullptr;
		return 0;
	}

	std::string normal_str = wideStringToString(string);
	char *normal_end = nullptr;
	long res = std::strtol(normal_str.c_str(), &normal_end, base);

	if (end_ptr) {
		if (normal_end && *normal_end) {
			size_t offset = normal_end - normal_str.c_str();
			*end_ptr = (uint16_t *)(string + offset);
		} else {
			*end_ptr = (uint16_t *)(string + normal_str.size());
		}
	}

	return res;
}

unsigned long wstrtoul(const uint16_t *string, uint16_t **end_ptr, int base) {
	if (!string) {
		if (end_ptr)
			*end_ptr = nullptr;
		return 0;
	}

	std::string normal_str = wideStringToString(string);
	char *normal_end = nullptr;
	unsigned long res = std::strtoul(normal_str.c_str(), &normal_end, base);

	if (end_ptr) {
		if (normal_end && *normal_end) {
			size_t offset = normal_end - normal_str.c_str();
			*end_ptr = (uint16_t *)(string + offset);
		} else {
			*end_ptr = (uint16_t *)(string + normal_str.size());
		}
	}

	return res;
}