diff --git a/c/src/lib/libbsp/powerpc/haleakala/make/custom/haleakala.cfg b/c/src/lib/libbsp/powerpc/haleakala/make/custom/haleakala.cfg
index 67ffe58ed1..e43b7397eb 100644
--- a/c/src/lib/libbsp/powerpc/haleakala/make/custom/haleakala.cfg
+++ b/c/src/lib/libbsp/powerpc/haleakala/make/custom/haleakala.cfg
@@ -17,6 +17,9 @@ CPU_CFLAGS = -mcpu=405 -Dppc405
 # -O4 is ok for RTEMS
 # NOTE: some level of -O may be actually required by inline assembler
 CFLAGS_OPTIMIZE_V = -O1 -g
+CFLAGS_OPTIMIZE_V += -ffunction-sections -fdata-sections
+
+LDFLAGS = -Wl,--gc-sections
 
 define bsp-post-link
 	$(default-bsp-post-link)