Back to 'waitForTransform' to make sure that tf works.

This prevent frameExists to fail because TF is not ready yet.
*but* it requires /map <-> /base_link to be published