#include <plotlablib/figurestubfactory.h>
#include <ros/ros.h>
#include <geometry_msgs/Point.h>
#include <iostream>
#include <string>