Use lock-free synchronization primitives

[AndyZe]

This presentation points out that mutexes are not real-time safe. It would be better if we used a lock-free alternative.

https://roscon.ros.org/2015/presentations/RealtimeROS2.pdf