fix: Fixed race condition in action server between is_ready and take. Backport from iron #2531 (#2635)

Signed-off-by: Camilo Camacho <camilo.im93@gmail.com>
Co-authored-by: Janosch Machowinski <J.Machowinski@cellumation.com>

Author: edgarcamilocamacho