banan-os/userspace/libraries/LibC/environ.cpp

#include <BAN/Assert.h>

#include <errno.h>
#include <stddef.h>
#include <stdint.h>
#include <stdlib.h>
#include <string.h>
#include <sys/weak_alias.h>

char** __environ;
weak_alias(__environ, environ);

static bool s_environ_malloced = false;
static size_t s_environ_count = 0;          // only valid when s_environ_malloced == true
static uint8_t* s_environ_bitmap = nullptr; // if bit i is set, environ[i] has to be freed

static bool is_bitmap_bit_set(size_t index)
{
	return !!(s_environ_bitmap[index / 8] & (1 << (index % 8)));
}

static void set_bitmap_bit(size_t index, bool value)
{
	if (value)
		s_environ_bitmap[index / 8] |=   1 << (index % 8);
	else
		s_environ_bitmap[index / 8] &= ~(1 << (index % 8));
}

static int malloc_environ()
{
	ASSERT(!s_environ_malloced);

	size_t environ_count = 0;
	while (environ && environ[environ_count])
		environ_count++;

	const size_t bitmap_size = (environ_count + 7) / 8;
	auto* new_bitmap = static_cast<uint8_t*>(malloc(bitmap_size));
	if (new_bitmap == nullptr)
		return -1;
	memset(new_bitmap, 0, bitmap_size);

	auto** new_environ = static_cast<char**>(malloc((environ_count + 1) * sizeof(char*)));
	if (new_environ == nullptr)
	{
		free(new_bitmap);
		return -1;
	}

	for (size_t i = 0; i < environ_count; i++)
		new_environ[i] = environ[i];
	new_environ[environ_count] = nullptr;

	environ = new_environ;
	s_environ_malloced = true;
	s_environ_count = environ_count;
	s_environ_bitmap = new_bitmap;

	return 0;
}

static int putenv_impl(char* string, bool malloced)
{
	if (!s_environ_malloced && malloc_environ() == -1)
		return -1;

	const char* eq_addr = strchr(string, '=');
	if (eq_addr == nullptr)
	{
		errno = EINVAL;
		return -1;
	}

	const size_t namelen = eq_addr - string;
	for (size_t i = 0; environ[i]; i++)
	{
		if (strncmp(environ[i], string, namelen + 1) != 0)
			continue;

		if (is_bitmap_bit_set(i))
			free(environ[i]);
		set_bitmap_bit(i, malloced);

		environ[i] = string;
		return 0;
	}

	if (s_environ_count % 8 == 0)
	{
		const size_t bytes = s_environ_count / 8 + 1;

		auto* new_bitmap = static_cast<uint8_t*>(realloc(s_environ_bitmap, bytes));
		if (new_bitmap == nullptr)
			return -1;

		s_environ_bitmap = new_bitmap;
		s_environ_bitmap[bytes - 1] = 0;
	}

	auto** new_environ = static_cast<char**>(realloc(environ, (s_environ_count + 2) * sizeof(char*)));
	if (new_environ == nullptr)
		return -1;

	environ = new_environ;
	environ[s_environ_count] = string;
	environ[s_environ_count + 1] = nullptr;

	set_bitmap_bit(s_environ_count, malloced);

	s_environ_count++;

	return 0;
}

int clearenv(void)
{
	if (s_environ_malloced)
	{
		ASSERT(environ);
		for (size_t i = 0; environ[i]; i++)
			if (is_bitmap_bit_set(i))
				free(environ[i]);
		free(s_environ_bitmap);
		free(environ);
	}

	environ = nullptr;
	s_environ_count = 0;
	s_environ_bitmap = nullptr;
	s_environ_malloced = false;
	return 0;
}

char* getenv(const char* name)
{
	if (environ == nullptr)
		return nullptr;
	const size_t namelen = strlen(name);
	for (size_t i = 0; environ[i]; i++)
		if (strncmp(name, environ[i], namelen) == 0 && environ[i][namelen] == '=')
			return environ[i] + namelen + 1;
	return nullptr;
}

int setenv(const char* name, const char* val, int overwrite)
{
	if (name == nullptr || !name[0] || strchr(name, '='))
	{
		errno = EINVAL;
		return -1;
	}

	if (!overwrite && getenv(name))
		return 0;

	const size_t namelen = strlen(name);
	const size_t vallen = strlen(val);

	auto* string = static_cast<char*>(malloc(namelen + vallen + 2));
	memcpy(string, name, namelen);
	string[namelen] = '=';
	memcpy(string + namelen + 1, val, vallen);
	string[namelen + vallen + 1] = '\0';

	return putenv_impl(string, true);
}

int unsetenv(const char* name)
{
	if (name == nullptr || !name[0] || strchr(name, '='))
	{
		errno = EINVAL;
		return -1;
	}

	if (environ == nullptr)
		return 0;

	const size_t namelen = strlen(name);

	size_t i = 0;
	for (; environ[i]; i++)
	{
		if (strncmp(environ[i], name, namelen) || environ[i][namelen] != '=')
			continue;
		if (s_environ_malloced && is_bitmap_bit_set(i))
			free(environ[i]);
		break;
	}

	for (; environ[i] && environ[i + 1]; i++)
	{
		environ[i] = environ[i + 1];
		if (!s_environ_malloced)
			continue;
		set_bitmap_bit(i, is_bitmap_bit_set(i + 1));
	}

	if (environ[i])
	{
		environ[i] = nullptr;

		if (s_environ_malloced)
		{
			set_bitmap_bit(i, false);
			s_environ_count--;
		}
	}

	return 0;
}

int putenv(char* string)
{
	if (string == nullptr || !string[0])
	{
		errno = EINVAL;
		return -1;
	}

	return putenv_impl(string, false);
}