Added waitForTransform to solve extrapolation into the future exception

Similarly to https://github.com/ros-planning/navigation/pull/254 and https://github.com/ros-planning/navigation/issues/196 the extrapolating into the future exception appears all the time in bufferCloud. Adding waitfortransform solves this problem.