code refactoring for enhancement base on the ROS style
Merge pull request #84 from irvs/issue71

code refactoring for enhancement base on the ROS style