seems ready. markers does not appear in rviz though