X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=Usermode%2FLibraries%2Fld-acess.so_src%2Flib.c;h=a3192bc82e2e59b5774dcfa2c594fa31339af3ec;hb=1b9f0a3100dd5bbfca97249cee2a4a98028e2eaf;hp=150ae77cff61812d0748f77f5d38ae393ac9c308;hpb=11686aa86bc0adae2555aa7796fe229770bb02f7;p=tpg%2Facess2.git

diff --git a/Usermode/Libraries/ld-acess.so_src/lib.c b/Usermode/Libraries/ld-acess.so_src/lib.c
index 150ae77c..a3192bc8 100644
--- a/Usermode/Libraries/ld-acess.so_src/lib.c
+++ b/Usermode/Libraries/ld-acess.so_src/lib.c
@@ -58,6 +58,13 @@ int memcmp(const void *p1, const void *p2, int len)
 	return 0;
 }
 
+void *memcpy(void *dest, const void *src, size_t len)
+{
+	uint8_t	*d=dest, *s=src;
+	while(len--)	*d++ = *s++;
+	return dest;
+}
+
 /**
  * \fn int file_exists(char *filename)
  * \brief Checks if a file exists
@@ -72,10 +79,47 @@ int file_exists(const char *filename)
 	return 1;
 }
 
-uint64_t __udivdi3(uint64_t Num, uint64_t Den)
+uint64_t __divmod64(uint64_t Num, uint64_t Den, uint64_t *Rem)
 {
 	uint64_t	ret = 0, add = 1;
 
+	if( Den == 0 ) {
+		if(Rem)	*Rem = 0;
+		return -1;
+	}
+
+	// Find what power of two times Den is > Num
+	while( Num >= Den )
+	{
+		Den <<= 1;
+		add <<= 1;
+	}
+
+	// Search backwards
+	while( add > 1 )
+	{
+		add >>= 1;
+		Den >>= 1;
+		// If the numerator is >= Den, subtract and add to return value
+		if( Num >= Den )
+		{
+			ret += add;
+			Num -= Den;
+		}
+	}
+	if(Rem)	*Rem = Num;
+	return ret;
+}
+
+uint32_t __divmod32(uint32_t Num, uint32_t Den, uint32_t *Rem)
+{
+	uint32_t	ret = 0, add = 1;
+
+	if( Den == 0 ) {
+		if(Rem)	*Rem = 0;
+		return -1;
+	}
+
 	// Find what power of two times Den is > Num
 	while( Num >= Den )
 	{
@@ -88,14 +132,69 @@ uint64_t __udivdi3(uint64_t Num, uint64_t Den)
 	{
 		add >>= 1;
 		Den >>= 1;
-		// If the numerator is > Den, subtract and add to return value
-		if( Num > Den )
+		// If the numerator is >= Den, subtract and add to return value
+		if( Num >= Den )
 		{
 			ret += add;
 			Num -= Den;
 		}
 	}
-//	if(Rem)	*Rem = Num;
+	if(Rem)	*Rem = Num;
+	return ret;
+}
+
+uint64_t __udivdi3(uint64_t Num, uint64_t Den)
+{
+	return __divmod64(Num, Den, NULL);
+}
+
+uint64_t __umoddi3(uint64_t Num, uint64_t Den)
+{
+	uint64_t	ret;
+	__divmod64(Num, Den, &ret);
+	return ret;
+}
+
+int32_t __divsi3(int32_t Num, int32_t Den)
+{
+	int32_t sign = 1;
+	if(Num < 0) {
+		Num = -Num;
+		sign = -sign;
+	}
+	if(Den < 0) {
+		Den = -Den;
+		sign = -sign;
+	}
+	return sign * __divmod32(Num, Den, NULL);
+}
+
+int32_t __modsi3(int32_t Num, int32_t Den)
+{
+	int32_t sign = 1;
+	uint32_t tmp;
+	if(Num < 0) {
+		Num = -Num;
+		sign = -sign;
+	}
+	if(Den < 0) {
+		Den = -Den;
+		sign = -sign;
+	}
+	__divmod32(Num, Den, &tmp);
+	return ((int32_t)tmp)*sign;
+}
+
+uint32_t __udivsi3(uint32_t Num, uint32_t Den)
+{
+	return __divmod32(Num, Den, NULL);
+}
+
+
+uint32_t __umodsi3(uint32_t Num, uint32_t Den)
+{
+	uint32_t	ret;
+	__divmod32(Num, Den, &ret);
 	return ret;
 }