#endif
 }
 
+static __always_inline void debug_enter(unsigned long *dr6, unsigned long *dr7)
+{
+       /*
+        * Disable breakpoints during exception handling; recursive exceptions
+        * are exceedingly 'fun'.
+        *
+        * Since this function is NOKPROBE, and that also applies to
+        * HW_BREAKPOINT_X, we can't hit a breakpoint before this (XXX except a
+        * HW_BREAKPOINT_W on our stack)
+        *
+        * Entry text is excluded for HW_BP_X and cpu_entry_area, which
+        * includes the entry stack is excluded for everything.
+        */
+       get_debugreg(*dr7, 7);
+       set_debugreg(0, 7);
+
+       /*
+        * Ensure the compiler doesn't lower the above statements into
+        * the critical section; disabling breakpoints late would not
+        * be good.
+        */
+       barrier();
+
+       /*
+        * The Intel SDM says:
+        *
+        *   Certain debug exceptions may clear bits 0-3. The remaining
+        *   contents of the DR6 register are never cleared by the
+        *   processor. To avoid confusion in identifying debug
+        *   exceptions, debug handlers should clear the register before
+        *   returning to the interrupted task.
+        *
+        * Keep it simple: clear DR6 immediately.
+        */
+       get_debugreg(*dr6, 6);
+       set_debugreg(0, 6);
+       /* Filter out all the reserved bits which are preset to 1 */
+       *dr6 &= ~DR6_RESERVED;
+}
+
+static __always_inline void debug_exit(unsigned long dr7)
+{
+       /*
+        * Ensure the compiler doesn't raise this statement into
+        * the critical section; enabling breakpoints early would
+        * not be good.
+        */
+       barrier();
+       set_debugreg(dr7, 7);
+}
+
 /*
  * Our handling of the processor debug registers is non-trivial.
  * We do not clear them on entry and exit from the kernel. Therefore
 dotraplinkage void do_debug(struct pt_regs *regs, long error_code)
 {
        struct task_struct *tsk = current;
+       unsigned long dr6, dr7;
        int user_icebp = 0;
-       unsigned long dr6;
        int si_code;
 
-       nmi_enter();
-
-       get_debugreg(dr6, 6);
-       /*
-        * The Intel SDM says:
-        *
-        *   Certain debug exceptions may clear bits 0-3. The remaining
-        *   contents of the DR6 register are never cleared by the
-        *   processor. To avoid confusion in identifying debug
-        *   exceptions, debug handlers should clear the register before
-        *   returning to the interrupted task.
-        *
-        * Keep it simple: clear DR6 immediately.
-        */
-       set_debugreg(0, 6);
+       debug_enter(&dr6, &dr7);
 
-       /* Filter out all the reserved bits which are preset to 1 */
-       dr6 &= ~DR6_RESERVED;
+       nmi_enter();
 
        /*
         * The SDM says "The processor clears the BTF flag when it
 #endif
 
        if (notify_die(DIE_DEBUG, "debug", regs, (long)&dr6, error_code,
-                                                       SIGTRAP) == NOTIFY_STOP)
+                      SIGTRAP) == NOTIFY_STOP)
                goto exit;
 
        /*
 
 exit:
        nmi_exit();
+       debug_exit(dr7);
 }
 NOKPROBE_SYMBOL(do_debug);