Use nav_msgs/Path instead of geometry_msgs/MultiDOFJointTrajectory for trajectory message