rqt_nav_view) Fix to Issue #27