Publish coordinates to topic /obj_pos