diff --git a/src/heap_useNewlib_ST.c b/src/heap_useNewlib_ST.c
index 1fb3987..b56419c 100644
--- a/src/heap_useNewlib_ST.c
+++ b/src/heap_useNewlib_ST.c
@@ -57,6 +57,16 @@
  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
 
+/**
+ * \author Henrik Stickann
+ * \data 20-January-2023
+ *
+ * Changes:
+ * 		* Add macro to only use implementation when requested by user
+ */
+#include <sta/config.hpp>
+#ifdef STA_RTOS_MALLOC_ENABLE
+
 // ================================================================================================
 // =======================================  Configuration  ========================================
 // These configuration symbols could be provided by from build...
@@ -285,3 +295,6 @@ size_t xPortGetFreeHeapSize( void ) PRIVILEGED_FUNCTION {
 
 //! No implementation needed, but stub provided in case application already calls vPortInitialiseBlocks
 void vPortInitialiseBlocks( void ) PRIVILEGED_FUNCTION {};
+
+
+#endif // STA_RTOS_MALLOC_ENABLE