Split into two policies.
Add in ros utils a generic conversion of different message, i.e. NavSts, to a vector or named map.
Replace synchonization with read_until