#include <cstdio>#include <iostream>#include <cstring>#include <fstream>#include <boost/program_options.hpp>#include <log.h>#include <frame.h>#include <datapairs.h>#include <value_setter.h>#include <optimizer_goal.h>#include <optimizer_goal_global_position.h>#include <optimizer_goal_global_orientation.h>#include <optimizer_goal_orientation.h>#include <optimizer_goal_position.h>#include <optimizer_container.h>#include <optimizer.h>