diff --git a/c/src/lib/libbsp/m68k/mcf5206elite/make/custom/mcf5206elite.cfg b/c/src/lib/libbsp/m68k/mcf5206elite/make/custom/mcf5206elite.cfg
index 7d48dab74d..b150e0404e 100644
--- a/c/src/lib/libbsp/m68k/mcf5206elite/make/custom/mcf5206elite.cfg
+++ b/c/src/lib/libbsp/m68k/mcf5206elite/make/custom/mcf5206elite.cfg
@@ -15,3 +15,6 @@ CPU_CFLAGS = -mcpu=5206
 
 # optimize flag: typically -O2
 CFLAGS_OPTIMIZE_V = -O2 -g -fomit-frame-pointer
+CFLAGS_OPTIMIZE_V += -ffunction-sections -fdata-sections
+
+LDFLAGS = -Wl,--gc-sections