就是用g2o建立各种约束方程 bool TebOptimalPlanner::buildGraph(double weight_multiplier) { if (!optimizer_->edges().empty