#include <allocator/solver/ThrustAllocation3DOFQPSolver.h>
#include <algorithm>
#include <cmath>
#include "utils/NodeUtils.h"