1 files changed, 10 insertions, 2 deletions

diff --git a/arch/microblaze/kernel/setup.c b/arch/microblaze/kernel/setup.c
index 9312fbb37efd..8e2c09b7ff26 100644
--- a/arch/microblaze/kernel/setup.c
+++ b/arch/microblaze/kernel/setup.c
@@ -95,7 +95,8 @@ inline unsigned get_romfs_len(unsigned *addr)
 void __init machine_early_init(const char *cmdline, unsigned int ram,
                 unsigned int fdt, unsigned int msr)
 {
-        unsigned long *src, *dst = (unsigned long *)0x0;
+        unsigned long *src, *dst;
+        unsigned int offset = 0;
 
         /* If CONFIG_MTD_UCLINUX is defined, assume ROMFS is at the
          * end of kernel. There are two position which we want to check.
@@ -168,7 +169,14 @@ void __init machine_early_init(const char *cmdline, unsigned int ram,
                                 "CPU have it %x\n", msr);
 #endif
 
-        for (src = __ivt_start; src < __ivt_end; src++, dst++)
+        /* Do not copy reset vectors. offset = 0x2 means skip the first
+         * two instructions. dst is pointer to MB vectors which are placed
+         * in block ram. If you want to copy reset vector setup offset to 0x0 */
+#if !CONFIG_MANUAL_RESET_VECTOR
+        offset = 0x2;
+#endif
+        dst = (unsigned long *) (offset * sizeof(u32));
+        for (src = __ivt_start + offset; src < __ivt_end; src++, dst++)
                 *dst = *src;
 
         /* Initialize global data */