fix

src/rm_auto_aim/armor_solver/src/trajectory_planner.cpp

@@ -295,6 +295,9 @@ void MpcPlanner::setupProblem() {
 }
 
 GimbalState MpcPlanner::plan(const TargetInfo& target, double dt) {
+    // Setup problem constraints and weights
+    setupProblem();
+
     int N = N_;
     double total_time = params_.sample_total_time;
     double time_step = total_time / N;