diff --git a/utils/hwstub/stub/crt0.S b/utils/hwstub/stub/crt0.S
index 5ba71905c9..8b2197823e 100644
--- a/utils/hwstub/stub/crt0.S
+++ b/utils/hwstub/stub/crt0.S
@@ -5,12 +5,14 @@
 start:
     sub     r7, pc, #8 /* Copy running address */
     msr     cpsr_c, #0xd3 /* enter supervisor mode, disable IRQ/FIQ */
+#ifdef CONFIG_STMP
     /* Disable MMU, disable caching and buffering;
      * use low exception range address */
     mrc     p15, 0, r0, c1, c0, 0
     ldr     r1, =0x3005
     bic     r0, r1
     mcr     p15, 0, r0, c1, c0, 0
+#endif
     ldr     sp, =oc_stackend
     /* Relocate to right address */
     mov    r2, r7