Add rostest for catkin fixed

this will revised version of #24