MTS-simulation test version

This contains the simulation version from summer to 2018-10-26, and may have some bugs when apply to real robot, the robot id and robot tf transform id is set to fit the gazebo simulation, so if you want to apply it in your real robot, please skip to our latest version.