vls/autoopt-cpp
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

add blts

Browse Source
This commit is contained in:
Valentin Leon Stöcker
2026-01-21 15:27:17 +01:00
parent 650e5cc6b8
commit 16334e4834
7 changed files with 195 additions and 143 deletions
Download Patch File Download Diff File Expand all files Collapse all files
include/autoopt/optimization_problem.hpp
+47 -46
View File
@@ -1,108 +1,109 @@
#pragma once
#include <array>
#include <cstddef>
#include "autoopt/derivative.hpp"
namespace autoopt {
template <typename T, size_t N>
template <typename T>
struct optimization_problem {
virtual std::array<T, N> initial_guess() = 0;
virtual Eigen::VectorX<T>& initial_guess() = 0;
virtual Eigen::VectorX<T>& x() = 0;
virtual T objective(const std::array<T, N>& params) = 0;
virtual std::array<T, N> gradient(const std::array<T, N>& params) = 0;
virtual matrix_t<T, N, N> hessian(const std::array<T, N>& params) = 0;
virtual T objective(const Eigen::VectorX<T>& params) = 0;
virtual Eigen::VectorX<T> gradient(const Eigen::VectorX<T>& params) = 0;
virtual Eigen::MatrixX<T> hessian(const Eigen::VectorX<T>& params) = 0;
};
template <typename T, size_t N, class Func>
struct auto_diff_optimization_problem : public optimization_problem<T, N> {
template <typename T, class Func>
struct auto_diff_optimization_problem : public optimization_problem<T> {
Func _objective_func;
std::array<T, N> _initial_guess;
Eigen::VectorX<T> _initial_guess;
Eigen::VectorX<T> _x;
auto_diff_optimization_problem(
Func objective_func, std::array<T, N> initial_guess = std::array<T, N>{})
: _objective_func(objective_func), _initial_guess(initial_guess) {}
Func objective_func, Eigen::VectorX<T> initial_guess = Eigen::VectorX<T>{})
: _objective_func(objective_func), _initial_guess(initial_guess), _x(initial_guess) {}
std::array<T, N> initial_guess() override { return _initial_guess; }
Eigen::VectorX<T>& initial_guess() override { return _initial_guess; }
T objective(const std::array<T, N>& params) override {
Eigen::VectorX<T>& x() override { return _x; }
T objective(const Eigen::VectorX<T>& params) override {
return _objective_func(params);
}
std::array<T, N> gradient(const std::array<T, N>& params) override {
return autoopt::gradient<T, N>(_objective_func, params);
Eigen::VectorX<T> gradient(const Eigen::VectorX<T>& params) override {
return autoopt::gradient<T>(_objective_func, params);
}
matrix_t<T, N, N> hessian(const std::array<T, N>& params) override {
return autoopt::hessian<T, N>(_objective_func, params);
Eigen::MatrixX<T> hessian(const Eigen::VectorX<T>& params) override {
return autoopt::hessian<T>(_objective_func, params);
}
};
template <typename T, size_t N>
template <typename T>
struct log_barrier_optimization_problem
: public optimization_problem<T, N> {
optimization_problem<T, N>& _base_problem;
std::array<T, N> _delta;
: public optimization_problem<T> {
optimization_problem<T>& _base_problem;
Eigen::VectorX<T> _delta;
T _barrier_strength;
log_barrier_optimization_problem(
optimization_problem<T, N>& base_problem,
std::array<T, N> delta,
optimization_problem<T>& base_problem,
Eigen::VectorX<T> delta,
T barrier_strength = T{1e-3})
: _base_problem(base_problem),
_delta(delta),
_barrier_strength(barrier_strength) {}
std::array<T, N> initial_guess() override {
Eigen::VectorX<T>& initial_guess() override {
return _base_problem.initial_guess();
}
T objective(const std::array<T, N>& params) override {
Eigen::VectorX<T>& x() override {
return _base_problem.x();
}
T objective(const Eigen::VectorX<T>& params) override {
T base_obj = _base_problem.objective(params);
T barrier = barrier_term(params);
return base_obj + barrier;
}
std::array<T, N> gradient(const std::array<T, N>& params) override {
Eigen::VectorX<T> gradient(const Eigen::VectorX<T>& params) override {
auto base_grad = _base_problem.gradient(params);
std::array<T, N> barrier_grad = autoopt::gradient<T, N>(
[this]<typename U>(const std::array<U, N>& p) {
Eigen::VectorX<T> barrier_grad = autoopt::gradient<T>(
[this]<typename U>(const Eigen::VectorX<U>& p) {
return barrier_term<U>(p);
},
params);
std::array<T, N> total_grad;
for (size_t i = 0; i < N; ++i) {
total_grad[i] = base_grad[i] + barrier_grad[i];
}
Eigen::VectorX<T> total_grad(params.size());
total_grad = base_grad + barrier_grad;
return total_grad;
}
matrix_t<T, N, N> hessian(const std::array<T, N>& params) override {
Eigen::MatrixX<T> hessian(const Eigen::VectorX<T>& params) override {
auto base_hess = _base_problem.hessian(params);
matrix_t<T, N, N> barrier_hess = autoopt::hessian<T, N>(
[this]<typename U>(const std::array<U, N>& p) {
Eigen::MatrixX<T> barrier_hess = autoopt::hessian<T>(
[this]<typename U>(const Eigen::VectorX<U>& p) {
return barrier_term<U>(p);
},
params);
matrix_t<T, N, N> total_hess;
for (size_t i = 0; i < N; ++i) {
for (size_t j = 0; j < N; ++j) {
total_hess[i][j] = base_hess[i][j] + barrier_hess[i][j];
}
}
Eigen::MatrixX<T> total_hess(params.size(), params.size());
total_hess = base_hess + barrier_hess;
return total_hess;
}
private:
template <typename U>
U barrier_term(const std::array<U, N>& params) {
U barrier_term(const Eigen::VectorX<U>& params) {
U barrier = U{0};
for (size_t i = 0; i < N; ++i) {
U lb = _base_problem.initial_guess()[i] - _delta[i];
U ub = _base_problem.initial_guess()[i] + _delta[i];
barrier = barrier + std::log(params[i] - lb) + std::log(ub - params[i]);
for (int i = 0; i < params.size(); ++i) {
U lb = U{_base_problem.initial_guess()(i) - _delta(i)};
U ub = U{_base_problem.initial_guess()(i) + _delta(i)};
barrier = barrier + std::log(params(i) - lb) + std::log(ub - params(i));
}
return -U{_barrier_strength} * barrier;
}