add the option to visualize mrs_msgs::Path directly

add the option to visualize mrs_msgs::Path directly #7