New convertPointToPose function, increased sleep time for loading publishers