+static int mips_ejtag_step_disable(struct mips_ejtag *ejtag_info)
+{
+ static const uint32_t code[] = {
+ MIPS32_MTC0(15, 31, 0), /* move $15 to COP0 DeSave */
+ MIPS32_LUI(15, UPPER16(MIPS32_PRACC_STACK)), /* $15 = MIPS32_PRACC_STACK */
+ MIPS32_ORI(15, 15, LOWER16(MIPS32_PRACC_STACK)),
+ MIPS32_SW(1, 0, 15), /* sw $1,($15) */
+ MIPS32_SW(2, 0, 15), /* sw $2,($15) */
+ MIPS32_MFC0(1, 23, 0), /* move COP0 Debug to $1 */
+ MIPS32_LUI(2, 0xFFFF), /* $2 = 0xfffffeff */
+ MIPS32_ORI(2, 2, 0xFEFF),
+ MIPS32_AND(1, 1, 2),
+ MIPS32_MTC0(1, 23, 0), /* move $1 to COP0 Debug */
+ MIPS32_LW(2, 0, 15),
+ MIPS32_LW(1, 0, 15),
+ MIPS32_B(NEG16(13)),
+ MIPS32_MFC0(15, 31, 0), /* move COP0 DeSave to $15 */
+ };
+
+ return mips32_pracc_exec(ejtag_info, ARRAY_SIZE(code), code,
+ 0, NULL, 0, NULL, 1);