ardrone_trajectory now also publish trajectory on a topic