Avoid deadlocks for failed command switching

[saikishor]

Maybe needed for #2733

[codecov]

Codecov Report

❌ Patch coverage is 98.41270% with 1 line in your changes missing coverage. Please review.
✅ Project coverage is 89.60%. Comparing base (29941a8) to head (40ed23c).
⚠️ Report is 1 commits behind head on master.

Files with missing lines	Patch %	Lines
...ace_testing/test/test_components/test_actuator.cpp	75.00%	0 Missing and 1 partial ⚠️

Additional details and impacted files

@@            Coverage Diff             @@
##           master    #2774      +/-   ##
==========================================
+ Coverage   89.57%   89.60%   +0.03%     
==========================================
  Files         152      152              
  Lines       17711    17774      +63     
  Branches     1458     1460       +2     
==========================================
+ Hits        15864    15926      +62     
  Misses       1257     1257              
- Partials      590      591       +1     

Flag	Coverage Δ
unittests	89.60% <98.41%> (+0.03%)	⬆️

Flags with carried forward coverage won't be shown. Click here to find out more.

Files with missing lines	Coverage Δ
controller_manager/src/controller_manager.cpp	77.03% <100.00%> (+0.02%)	⬆️
...ller_manager/test/test_controller_manager_srvs.cpp	99.37% <100.00%> (+0.03%)	⬆️
...ace_testing/test/test_components/test_actuator.cpp	88.73% <75.00%> (-0.82%)	⬇️

🚀 New features to boost your workflow:

• ❄️ Test Analytics: Detect flaky tests, report on failures, and find test suite problems.