[PATCH 4/5] powerpc/lib/sstep: Add prty instruction emulation

[Matt Brown]

This add emulation for the prtyw and prtyd instructions.
Tested for logical correctness against the prtyw and prtyd instructions
on ppc64le.

Signed-off-by: Matt Brown <matthew.brown....@gmail.com>
---
v2:
        - fixed opcodes
        - fixed bitshifting and typecast errors
        - merged do_prtyw and do_prtyd into single function
---
 arch/powerpc/lib/sstep.c | 31 +++++++++++++++++++++++++++++++
 1 file changed, 31 insertions(+)

diff --git a/arch/powerpc/lib/sstep.c b/arch/powerpc/lib/sstep.c
index a756f44..1820fd6 100644
--- a/arch/powerpc/lib/sstep.c
+++ b/arch/powerpc/lib/sstep.c
@@ -658,6 +658,29 @@ static nokprobe_inline void do_bpermd(struct pt_regs 
*regs, unsigned long v1,
        regs->gpr[ra] = perm;
 }
 #endif /* __powerpc64__ */
+/*
+ * The size parameter adjusts the equivalent prty instruction.
+ * prtyw = 32, prtyd = 64
+ */
+static nokprobe_inline void do_prty(struct pt_regs *regs, unsigned long v,
+                               int size, int ra)
+{
+       unsigned long long high, low;
+       unsigned int i;
+
+       high = 0;
+       low = 0;
+
+       for (i = 0; i < 8; i++) {
+               if (v & (1UL << (i * 8)))
+                       (i < 4) ? (low++) : (high++);
+       }
+
+       if (size == 32)
+               regs->gpr[ra] = ((high & 1) << 32) | (low & 1);
+       else
+               regs->gpr[ra] = (high + low) & 1;
+}
 
 static nokprobe_inline int trap_compare(long v1, long v2)
 {
@@ -1248,6 +1271,14 @@ int analyse_instr(struct instruction_op *op, struct 
pt_regs *regs,
                case 124:       /* nor */
                        regs->gpr[ra] = ~(regs->gpr[rd] | regs->gpr[rb]);
                        goto logical_done;
+
+               case 154:       /* prtyw */
+                       do_prty(regs, regs->gpr[rd], 32, ra);
+                       goto logical_done;
+
+               case 186:       /* prtyd */
+                       do_prty(regs, regs->gpr[rd], 64, ra);
+                       goto logical_done;
 #ifdef __powerpc64__
                case 252:       /* bpermd */
                        do_bpermd(regs, regs->gpr[rd], regs->gpr[rb], ra);
-- 
2.9.3