#include <assert.h>
#include "primitive.h"
#include "relativepositionsensor.h"
#include "sensor.h"
#include "mathutils.h"
forward declarations