#include "TrajectoryController.h"
#include <iostream>
#include <QMessageBox>
#include "../Util/OrientationConversion.h"