Fennix/Userspace/libc/interpreter/helper.c

/*
	This file is part of Fennix C Library.

	Fennix C Library is free software: you can redistribute it and/or
	modify it under the terms of the GNU General Public License as
	published by the Free Software Foundation, either version 3 of
	the License, or (at your option) any later version.

	Fennix C Library is distributed in the hope that it will be useful,
	but WITHOUT ANY WARRANTY; without even the implied warranty of
	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	GNU General Public License for more details.

	You should have received a copy of the GNU General Public License
	along with Fennix C Library. If not, see <https://www.gnu.org/licenses/>.
*/

#include <bits/libc.h>
#include <sys/types.h>
#include <stdint.h>
#include <stddef.h>
#include <errno.h>

#include "elf.h"
#include "misc.h"

void *memset(void *s, int c, size_t n)
{
	uint8_t *p = s;
	while (n--)
		*p++ = c;
	return s;
}

void *memcpy(void *dest, const void *src, size_t n)
{
	uint8_t *d = dest;
	const uint8_t *s = src;
	while (n--)
		*d++ = *s++;
	return dest;
}

size_t strlen(const char *s)
{
	const char *p = s;
	while (*p)
		p++;
	return p - s;
}

char *strcpy(char *dest, const char *src)
{
	char *d = dest;
	while ((*d++ = *src++))
		;
	return dest;
}

int strcmp(const char *l, const char *r)
{
	while (*l && *l == *r)
	{
		l++;
		r++;
	}
	return *l - *r;
}

int strncmp(const char *s1, const char *s2, size_t n)
{
	for (size_t i = 0; i < n; i++)
	{
		char c1 = s1[i], c2 = s2[i];
		if (c1 != c2)
			return c1 - c2;
		if (!c1)
			return 0;
	}
	return 0;
}

char *strcat(char *dest, const char *src)
{
	char *d = dest;
	while (*d)
		d++;
	while ((*d++ = *src++))
		;
	return dest;
}

char *strrchr(const char *str, int c)
{
	const char *last_occurrence = NULL;

	while (*str)
	{
		if (*str == (char)c)
			last_occurrence = str;
		str++;
	}

	if (c == '\0')
		return (char *)str;

	return (char *)last_occurrence;
}

char *strncpy(char *destination, const char *source, unsigned long num)
{
	if (destination == NULL)
		return NULL;

	char *ptr = destination;
	while (*source && num--)
	{
		*destination = *source;
		destination++;
		source++;
	}

	*destination = '\0';
	return ptr;
}

char *strdup(const char *str)
{
	char *buf = (char *)mini_malloc(strlen((char *)str) + 1);
	strncpy(buf, str, strlen(str) + 1);
	return buf;
}

unsigned int isdelim(char c, const char *delim)
{
	while (*delim != '\0')
	{
		if (c == *delim)
			return 1;
		delim++;
	}
	return 0;
}

char *strtok(char *src, const char *delim)
{
	static char *src1;
	if (!src)
		src = src1;

	if (!src)
		return NULL;

	while (1)
	{
		if (isdelim(*src, (char *)delim))
		{
			src++;
			continue;
		}
		if (*src == '\0')
			return NULL;

		break;
	}
	char *ret = src;
	while (1)
	{
		if (*src == '\0')
		{
			src1 = src;
			return ret;
		}
		if (isdelim(*src, (char *)delim))
		{
			*src = '\0';
			src1 = src + 1;
			return ret;
		}
		src++;
	}
	return NULL;
}

char **environ;
char *getenv(const char *name)
{
	if (name == NULL)
		return NULL;

	size_t len = strlen(name);
	for (char **env = environ; *env != 0; ++env)
	{
		char *thisEnv = *env;
		char cmp = strncmp(thisEnv, name, len) == 0;
		if (cmp && thisEnv[len] == '=')
			return thisEnv + len + 1;
	}
	return NULL;
}

unsigned long elf_hash(const unsigned char *name)
{
	unsigned long hash = 0, high;
	while (*name)
	{
		hash = (hash << 4) + *name++;
		if ((high = hash & 0xF0000000))
			hash ^= high >> 24;
		hash &= ~high;
	}
	return hash;
}

uint32_t gnu_hash(const char *name)
{
	uint32_t hash = 5381;
	for (; *name; name++)
	{
		hash = (hash << 5) + hash + (unsigned char)(*name); // hash * 33 + c
	}
	return hash;
}

Elf64_Sym *find_symbol(const char *name, uint32_t *hash_table, Elf64_Sym *symtab, const char *strtab)
{
	/* Symbol Hash Table
	|-------------------|
	|      nbucket      |
	|-------------------|
	|      nchain       |
	|-------------------|
	|     bucket[0]     |
	|      . . .        |
	|bucket[nbucket - 1]|
	|-------------------|
	|     chain[0]      |
	|      . . .        |
	| chain[nchain - 1] |
	|-------------------|
	*/
	unsigned long h = elf_hash(name);		  // or gnu_hash(name)
	unsigned long bucket = h % hash_table[0]; // hash_table[0] = nbucket

	for (unsigned long i = hash_table[2 + bucket];
		 i != STN_UNDEF;
		 i = hash_table[2 + hash_table[0] + i])
	{
		if (!strcmp(&strtab[symtab[i].st_name], name))
			return &symtab[i];
	}
	return NULL;
}