void OpenHRP_PathPlannerSVC_impl::clearRoadmap()
{
    PathEngine::Roadmap *rm = path_->getRoadmap();
    rm->clear();
}