Add delay after P mode stopped

Added 500 ms delay after pressure mode is stopped to avoid crashing
threads.