diff --git a/bsp/mb9bf506r/rtconfig.h b/bsp/mb9bf506r/rtconfig.h
index 8bded645af45544bd084b138079e062e71c85d04..c0969485bded8cdbe00f5aad68e8f3bc5b5cebd6 100644
--- a/bsp/mb9bf506r/rtconfig.h
+++ b/bsp/mb9bf506r/rtconfig.h
@@ -52,6 +52,8 @@
 // <section name="MM" description="Memory Management" default="always" >
 // <bool name="RT_USING_MEMPOOL" description="Using Memory Pool Management in the system" default="true" />
 #define RT_USING_MEMPOOL
+// <bool name="RT_USING_MEMHEAP" description="Using Memory Heap Management in the system" default="true" />
+#define RT_USING_MEMHEAP
 // <bool name="RT_USING_HEAP" description="Using Dynamic Heap Management in the system" default="true" />
 #define RT_USING_HEAP
 // <bool name="RT_USING_SMALL_MEM" description="Optimizing for small memory" default="false" />
diff --git a/src/SConscript b/src/SConscript
index afc784f75a5b06bc8b4f23c7bd207dc38ef920c7..a8e8a0dcaa6ab81e6319296622ad6a0db4452a3d 100644
--- a/src/SConscript
+++ b/src/SConscript
@@ -19,6 +19,15 @@ if GetDepend('RT_USING_HEAP') == False or GetDepend('RT_USING_SMALL_MEM') == Fal
 if GetDepend('RT_USING_HEAP') == False or GetDepend('RT_USING_SLAB') == False:
     SrcRemove(src, ['slab.c'])
 
+if GetDepend('RT_USING_MEMPOOL') == False:
+    SrcRemove(src, ['mempool.c'])
+
+if GetDepend('RT_USING_MEMHEAP') == False:
+    SrcRemove(src, ['memheap.c'])
+
+if GetDepend('RT_USING_DEVICE') == False:
+    SrcRemove(src, ['device.c'])
+
 group   = DefineGroup('Kernel', src, depend = [''], CPPPATH = CPPPATH, LINKFLAGS = LINKFLAGS)
 
 Return('group')