1 files changed, 17 insertions, 0 deletions

diff --git a/arch/powerpc/lib/sstep.c b/arch/powerpc/lib/sstep.c
index e79123d1485c..666c2aa55016 100644
--- a/arch/powerpc/lib/sstep.c
+++ b/arch/powerpc/lib/sstep.c
@@ -10,13 +10,18 @@
  */
 #include <linux/kernel.h>
 #include <linux/ptrace.h>
+#include <linux/config.h>
 #include <asm/sstep.h>
 #include <asm/processor.h>
 
 extern char system_call_common[];
 
+#ifdef CONFIG_PPC64
 /* Bits in SRR1 that are copied from MSR */
 #define MSR_MASK        0xffffffff87c0ffff
+#else
+#define MSR_MASK        0x87c0ffff
+#endif
 
 /*
  * Determine whether a conditional branch instruction would branch.
@@ -66,6 +71,7 @@ int emulate_step(struct pt_regs *regs, unsigned int instr)
                 if (branch_taken(instr, regs))
                         regs->nip = imm;
                 return 1;
+#ifdef CONFIG_PPC64
         case 17:        /* sc */
                 /*
                  * N.B. this uses knowledge about how the syscall
@@ -79,6 +85,7 @@ int emulate_step(struct pt_regs *regs, unsigned int instr)
                 regs->nip = (unsigned long) &system_call_common;
                 regs->msr = MSR_KERNEL;
                 return 1;
+#endif
         case 18:        /* b */
                 imm = instr & 0x03fffffc;
                 if (imm & 0x02000000)
@@ -121,6 +128,15 @@ int emulate_step(struct pt_regs *regs, unsigned int instr)
                         if ((regs->msr & MSR_SF) == 0)
                                 regs->nip &= 0xffffffffUL;
                         return 1;
+                case 0x124:     /* mtmsr */
+                        imm = regs->gpr[rd];
+                        if ((imm & MSR_RI) == 0)
+                                /* can't step mtmsr that would clear MSR_RI */
+                                return -1;
+                        regs->msr = imm;
+                        regs->nip += 4;
+                        return 1;
+#ifdef CONFIG_PPC64
                 case 0x164:     /* mtmsrd */
                         /* only MSR_EE and MSR_RI get changed if bit 15 set */
                         /* mtmsrd doesn't change MSR_HV and MSR_ME */
@@ -135,6 +151,7 @@ int emulate_step(struct pt_regs *regs, unsigned int instr)
                         if ((imm & MSR_SF) == 0)
                                 regs->nip &= 0xffffffffUL;
                         return 1;
+#endif
                 }
         }
         return 0;