add test code
add catkin_make test
Merge pull request #7 from k-okada/master

add test