调试 MTC 任务

RViz 中的 Motion Planning Tasks 面板会列出当前 MTC 任务中的所有阶段（stage）。点击某个阶段即可查看它的解，失败的解会附带一段描述性的失败原因。