diff --git a/board/freescale/mx7ulp_evk/imximage.cfg b/board/freescale/mx7ulp_evk/imximage.cfg
index f547a8eedbcbaf0afc8d6ef9ae81f420ce1d92e2..48dcbebdd526988a851b80dd24efe1c0d2410e0f 100644
--- a/board/freescale/mx7ulp_evk/imximage.cfg
+++ b/board/freescale/mx7ulp_evk/imximage.cfg
@@ -44,8 +44,14 @@ CSF CONFIG_CSF_SIZE
  */
 DATA 4   0x403f00dc 0x00000000
 DATA 4   0x403e0040 0x01000020
+DATA 4   0x403e0500 0x01000000
 DATA 4   0x403e050c 0x80808080
-DATA 4   0x403e050c 0x8080801E
+DATA 4   0x403e0508 0x00160000
+DATA 4   0x403E0510 0x00000002
+DATA 4   0x403E0514 0x00000005
+DATA 4   0x403e0500 0x00000001
+CHECK_BITS_SET 4 0x403e0500 0x01000000
+DATA 4   0x403e050c 0x80808020
 CHECK_BITS_SET 4 0x403e050c 0x00000040
 DATA 4   0x403E0030 0x00000001
 DATA 4   0x403e0040 0x11000020
diff --git a/board/freescale/mx7ulp_evk/plugin.S b/board/freescale/mx7ulp_evk/plugin.S
index 2a5b551bca8c6d87093020500343de04564b43cd..6c09382b64cf359ab22af88d28f341f6280b19d2 100644
--- a/board/freescale/mx7ulp_evk/plugin.S
+++ b/board/freescale/mx7ulp_evk/plugin.S
@@ -14,10 +14,28 @@
 	ldr r2, =0x403e0000
 	ldr r3, =0x01000020
 	str r3, [r2, #0x40]
+	ldr r3, =0x01000000
+	str r3, [r2, #0x500]
 
 	ldr r3, =0x80808080
 	str r3, [r2, #0x50c]
-	ldr r3, =0x8080801E
+	ldr r3, =0x00160000
+	str r3, [r2, #0x508]
+	ldr r3, =0x00000002
+	str r3, [r2, #0x510]
+	ldr r3, =0x00000005
+	str r3, [r2, #0x514]
+	ldr r3, =0x00000001
+	str r3, [r2, #0x500]
+	
+	ldr r3, =0x01000000
+wait1:
+	ldr r4, [r2, #0x500]
+	and r4, r3
+	cmp r4, r3
+	bne wait1
+
+	ldr r3, =0x80808020
 	str r3, [r2, #0x50c]
 
 	ldr r3, =0x00000040