#include <new>#include "RAPiD.h"#include "Math/FloatMatrix.h"#include "Math/FloatVector.h"#include "Math/LinearAlgebra.h"#include "Calibration/Calibration.h"#include "DataStructures/DynamicArray.h"#include "Image/ImageProcessor.h"#include "Image/ByteImage.h"#include "Tracking/ICP.h"#include <stdio.h>