#include <limits>
#include "airplanecost.h"
#include "gunicyclemanifold.h"
#include "se2.h"
#include <iostream>
#include <assert.h>