Wait in the M25 command handler until the work_handler() background timer fully exits. This ensures that subsequent g-code commands (such as M27 or M24) will correctly report a paused state. Reported by @foosel. Signed-off-by: Kevin O'Connor <kevin@koconnor.net>