#include <stdlib.h>
#include <iostream>
#include "XsensData.hpp"
#include "XsensDriver.hpp"
#include <stdexcept>