Test for deadlock in simple_action_server.

Thanks to @dirk-thomas for code review + fixes.