#include <allocator/ThrustAllocator.h>
#include <allocator/config/T200ThrusterLookup.h>
#include <allocator/solver/ThrustAllocation6DOFQPSolver.h>
#include <cmath>
#include <memory>
#include <rclcpp/utilities.hpp>
#include "utils/NodeUtils.h"