multistart.hpp

// Copyright (c) Sleipnir contributors
 
#pragma once
 
#include <algorithm>
#include <future>
#include <span>
 
#include <gch/small_vector.hpp>
 
#include "sleipnir/optimization/solver/exit_status.hpp"
#include "sleipnir/util/function_ref.hpp"
 
namespace slp {
 
template <typename Scalar, typename DecisionVariables>
struct MultistartResult {
  ExitStatus status;
  Scalar cost;
  DecisionVariables variables;
};
 
template <typename Scalar, typename DecisionVariables>
MultistartResult<Scalar, DecisionVariables> Multistart(
    function_ref<MultistartResult<Scalar, DecisionVariables>(
        const DecisionVariables& initial_guess)>
        solve,
    std::span<const DecisionVariables> initial_guesses) {
  gch::small_vector<std::future<MultistartResult<Scalar, DecisionVariables>>>
      futures;
  futures.reserve(initial_guesses.size());
 
  for (const auto& initial_guess : initial_guesses) {
    futures.emplace_back(std::async(std::launch::async, solve, initial_guess));
  }
 
  gch::small_vector<MultistartResult<Scalar, DecisionVariables>> results;
  results.reserve(futures.size());
 
  for (auto& future : futures) {
    results.emplace_back(future.get());
  }
 
  return *std::ranges::min_element(results, [](const auto& a, const auto& b) {
    // Prioritize successful solve
    if (a.status == ExitStatus::SUCCESS && b.status != ExitStatus::SUCCESS) {
      return true;
    }
 
    // Otherwise prioritize solution with lower cost
    return a.cost < b.cost;
  });
}
 
}  // namespace slp