Add rostest for catkin fixed

this will revized version of #24