1 files changed, 6 insertions, 4 deletions

diff --git a/arch/blackfin/mm/isram-driver.c b/arch/blackfin/mm/isram-driver.c
index 02eaaa641d49..beb1a608824c 100644
--- a/arch/blackfin/mm/isram-driver.c
+++ b/arch/blackfin/mm/isram-driver.c
@@ -53,10 +53,12 @@ static DEFINE_SPINLOCK(dtest_lock);
 #define IADDR2DTEST(x) \
         ({ unsigned long __addr = (unsigned long)(x); \
                 (__addr & 0x47F8)        | /* address bits 14 & 10:3 */ \
+                (__addr & 0x8000) << 23  | /* Bank A/B               */ \
                 (__addr & 0x0800) << 15  | /* address bit  11        */ \
-                (__addr  & 0x3000) << 4  | /* address bits 13:12     */ \
-                (__addr  & 0x8000) << 8  | /* address bit  15        */ \
-                (0x1000004);               /* isram access           */ \
+                (__addr & 0x3000) <<  4  | /* address bits 13:12     */ \
+                (__addr & 0x8000) <<  8  | /* address bit  15        */ \
+                (0x1000000)              | /* instruction access = 1 */ \
+                (0x4);                     /* data array = 1         */ \
         })
 
 /* Takes a pointer, and returns the offset (in bits) which things should be shifted */
@@ -73,7 +75,7 @@ static void isram_write(const void *addr, uint64_t data)
         if (addr >= (void *)(L1_CODE_START + L1_CODE_LENGTH))
                 return;
 
-        cmd = IADDR2DTEST(addr) | 1;             /* write */
+        cmd = IADDR2DTEST(addr) | 2;             /* write */
 
         /*
          * Writes to DTEST_DATA[0:1] need to be atomic with write to DTEST_COMMAND