diff --git a/c/src/lib/libbsp/arm/lpc176x/make/custom/lpc1768_mbed.cfg b/c/src/lib/libbsp/arm/lpc176x/make/custom/lpc1768_mbed.cfg
index 7923264ecf..3e9255e88f 100644
--- a/c/src/lib/libbsp/arm/lpc176x/make/custom/lpc1768_mbed.cfg
+++ b/c/src/lib/libbsp/arm/lpc176x/make/custom/lpc1768_mbed.cfg
@@ -9,11 +9,8 @@ RTEMS_CPU = arm
 CPU_CFLAGS = -march=armv7-m -mthumb
 
 CFLAGS_OPTIMIZE_V = -O2 -ggdb3
-
-# FIXME: Disabled because linkcmds lacks proper KEEP() directives. See #2561.
-# Add CFLAGS and LDFLAGS for compiling and linking with per item sections
-# CFLAGS_OPTIMIZE_V += -ffunction-sections -fdata-sections
-# LDFLAGS            = -Wl,--gc-sections
+CFLAGS_OPTIMIZE_V += -ffunction-sections -fdata-sections
+LDFLAGS            = -Wl,--gc-sections
 
 BINEXT?=.bin
 # This defines the operations performed on the linked executable.