#include "SplinePath.h"
#include <cassert>
#include <cmath>
#include <ArmarXCore/core/logging/Logging.h>