Changes from legacy_mode to version 0
Merge pull request #12 from thiagodefreitas/ros_i

Changes from legacy_mode to version 0