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