Improve ChibiOS memory functions

targets/ChibiOS/_common/platform_heap.c

@@ -4,28 +4,17 @@
 //
 
 #include <ch.h>
-#include <nanoHAL_v2.h>
+// #include <nanoHAL_v2.h> // Not required as we are fully using the platform specific implementation.
 
 void *platform_malloc(size_t size)
 {
-
-// need to undef in order to call the real function
-#undef malloc
-
-    return malloc(size);
-
-// define back
-#define malloc YOU_SHALL_NOT_USE_malloc
+    return chHeapAlloc(NULL, size);
 }
 
 void platform_free(void *ptr)
 {
-
-// need to undef in order to call the real function
-#undef free
-
-    free(ptr);
-
-// define back
-#define free YOU_SHALL_NOT_USE_free
+    if (ptr)
+    {
+        chHeapFree(ptr);
+    }
 }