now visualized in rviz
Merge pull request #6 from qiqiapple/master

now visualized in rviz