Improve ARM debug_monitor for SMP machines

• Reset debug architecture and enable monitor for secondary CPUs in init_secondary() rather than when configuring watchpoint, etc.
• Disable HW debugging capabilities when one of the CPU cores fails to set up.
• Use dbg_capable() in a more atomic manner to avoid any mismatch between CPUs.

Differential Revision: https://reviews.freebsd.org/D6009