diff --git a/c/src/lib/libbsp/m68k/mcf5235/make/custom/mcf5235.cfg b/c/src/lib/libbsp/m68k/mcf5235/make/custom/mcf5235.cfg
index b5c3c49ccb..f3a0861584 100644
--- a/c/src/lib/libbsp/m68k/mcf5235/make/custom/mcf5235.cfg
+++ b/c/src/lib/libbsp/m68k/mcf5235/make/custom/mcf5235.cfg
@@ -13,6 +13,9 @@ CPU_CFLAGS = -mcpu=5235
 
 # optimize flag: typically -O2
 CFLAGS_OPTIMIZE_V = -O2 -g -fomit-frame-pointer
+CFLAGS_OPTIMIZE_V += -ffunction-sections -fdata-sections
+
+LDFLAGS = -Wl,--gc-sections
 
 ifndef MTARGET
 MTARGET=ram