This commit is contained in:
cyy_mac
2026-03-27 06:00:43 +08:00
parent 6d6183620a
commit 7614d26c55

View File

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