From: David Daney <david.da...@cavium.com>

Introduce __compute_return_epc_for_insn0() entry point.

Signed-off-by: David Daney <david.da...@cavium.com>
---
 arch/mips/include/asm/branch.h |  7 +++++
 arch/mips/kernel/branch.c      | 63 +++++++++++++++++++++++++++++++-----------
 2 files changed, 54 insertions(+), 16 deletions(-)

diff --git a/arch/mips/include/asm/branch.h b/arch/mips/include/asm/branch.h
index e28a3e0..b3de685 100644
--- a/arch/mips/include/asm/branch.h
+++ b/arch/mips/include/asm/branch.h
@@ -37,6 +37,13 @@ static inline unsigned long exception_epc(struct pt_regs 
*regs)
 
 #define BRANCH_LIKELY_TAKEN 0x0001
 
+extern int __compute_return_epc(struct pt_regs *regs);
+extern int __compute_return_epc_for_insn(struct pt_regs *regs,
+                                        union mips_instruction insn);
+extern int __compute_return_epc_for_insn0(struct pt_regs *regs,
+                                         union mips_instruction insn,
+                                         unsigned int (*get_fcr31)(void));
+
 static inline int compute_return_epc(struct pt_regs *regs)
 {
        if (get_isa16_mode(regs->cp0_epc)) {
diff --git a/arch/mips/kernel/branch.c b/arch/mips/kernel/branch.c
index 46c2ad0..e47145b 100644
--- a/arch/mips/kernel/branch.c
+++ b/arch/mips/kernel/branch.c
@@ -195,17 +195,18 @@ int __MIPS16e_compute_return_epc(struct pt_regs *regs)
 }
 
 /**
- * __compute_return_epc_for_insn - Computes the return address and do emulate
+ * __compute_return_epc_for_insn0 - Computes the return address and do emulate
  *                                 branch simulation, if required.
  *
  * @regs:      Pointer to pt_regs
  * @insn:      branch instruction to decode
- * @returns:   -EFAULT on error and forces SIGBUS, and on success
+ * @returns:   -EFAULT on error, and on success
  *             returns 0 or BRANCH_LIKELY_TAKEN as appropriate after
  *             evaluating the branch.
  */
-int __compute_return_epc_for_insn(struct pt_regs *regs,
-                                  union mips_instruction insn)
+int __compute_return_epc_for_insn0(struct pt_regs *regs,
+                                  union mips_instruction insn,
+                                  unsigned int (*get_fcr31)(void))
 {
        unsigned int bit, fcr31, dspcontrol;
        long epc = regs->cp0_epc;
@@ -281,7 +282,7 @@ int __compute_return_epc_for_insn(struct pt_regs *regs,
 
                case bposge32_op:
                        if (!cpu_has_dsp)
-                               goto sigill;
+                               return -EFAULT;
 
                        dspcontrol = rddsp(0x01);
 
@@ -364,13 +365,7 @@ int __compute_return_epc_for_insn(struct pt_regs *regs,
         * And now the FPA/cp1 branch instructions.
         */
        case cop1_op:
-               preempt_disable();
-               if (is_fpu_owner())
-                       asm volatile("cfc1\t%0,$31" : "=r" (fcr31));
-               else
-                       fcr31 = current->thread.fpu.fcr31;
-               preempt_enable();
-
+               fcr31 = get_fcr31();
                bit = (insn.i_format.rt >> 2);
                bit += (bit != 0);
                bit += 23;
@@ -434,11 +429,47 @@ int __compute_return_epc_for_insn(struct pt_regs *regs,
        }
 
        return ret;
+}
+EXPORT_SYMBOL_GPL(__compute_return_epc_for_insn0);
 
-sigill:
-       printk("%s: DSP branch but not DSP ASE - sending SIGBUS.\n", 
current->comm);
-       force_sig(SIGBUS, current);
-       return -EFAULT;
+static unsigned int __get_fcr31(void)
+{
+       unsigned int fcr31;
+
+       preempt_disable();
+       if (is_fpu_owner())
+               asm volatile(
+                       ".set push\n"
+                       "\t.set mips1\n"
+                       "\tcfc1\t%0,$31\n"
+                       "\t.set pop" : "=r" (fcr31));
+       else
+               fcr31 = current->thread.fpu.fcr31;
+       preempt_enable();
+       return fcr31;
+}
+
+/**
+ * __compute_return_epc_for_insn - Computes the return address and do emulate
+ *                                 branch simulation, if required.
+ *
+ * @regs:      Pointer to pt_regs
+ * @insn:      branch instruction to decode
+ * @returns:   -EFAULT on error and forces SIGBUS, and on success
+ *             returns 0 or BRANCH_LIKELY_TAKEN as appropriate after
+ *             evaluating the branch.
+ */
+int __compute_return_epc_for_insn(struct pt_regs *regs,
+                                  union mips_instruction insn)
+{
+       int r =  __compute_return_epc_for_insn0(regs, insn, __get_fcr31);
+
+       if (r < 0) {
+               printk("%s: DSP branch but not DSP ASE - sending SIGBUS.\n", 
current->comm);
+               force_sig(SIGBUS, current);
+       }
+
+       return r;
 }
 EXPORT_SYMBOL_GPL(__compute_return_epc_for_insn);
 
-- 
1.7.11.7

--
To unsubscribe from this list: send the line "unsubscribe kvm" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to