#include <limits>
#include "kinbody2d.h"
#include "kinbody2dmanifold.h"
#include "rn.h"
#include "se2.h"
#include <iostream>
#include <assert.h>