add misc functionalities for supporting gazebo
add some functions for gazebo support
support gazebo
Merge pull request #53 from dartsim/gazebo_support

Gazebo support