Add remove ability to linked list.

1 files changed, 26 insertions, 3 deletions

diff --git a/src/kern/stdlibrepl.c b/src/kern/stdlibrepl.c
index 588191b..38b8477 100644
--- a/src/kern/stdlibrepl.c
+++ b/src/kern/stdlibrepl.c
@@ -15,14 +15,37 @@ size_t strlen(char* ch)
 
 #ifdef ARCH_STM32L4
 
-void memcpy(void* dest, void* src, size_t size)
+void* memcpy(void* dest, const void* src, size_t size)
 {
   uint8_t* dest_ = dest;
-  uint8_t* src_ = src;
+  const uint8_t* src_ = src;
 
-  while(size --) {
+  while (size--) {
     *(dest_++) = *(src_++);
   }
+
+  return dest;
+}
+
+int memcmp(const void* s1_, const void* s2_, size_t size)
+{
+  const uint8_t* s1 = s1_;
+  const uint8_t* s2 = s2_;
+
+  while (size--) {
+    if (*s1 != *s2) {
+      if (*s1 > *s2) {
+        return 1;
+      } else {
+        return -1;
+      }
+    }
+
+    ++s1;
+    ++s2;
+  }
+
+  return 0;
 }
 
 #endif