refactored. reduce global variables and simplize initialize step.
refactored. reduce global variables and simplize initialize step.

irvs/ros_tms,irvs/ros_tms,irvs/ros_tms,irvs/ros_tms,irvs/ros_tms,irvs/ros_tms,irvs/ros_tms,irvs/ros_tms,irvs/ros_tms