#include <eeros/control/PathPlannerCubic.hpp>
#include <eeros/core/System.hpp>
#include <iostream>
#include <fstream>
#include <unistd.h>