#include <labust/vehicles/PlaDyPosNode.hpp>
#include <labust/vehicles/Allocation.hpp>
#include <labust/math/NumberManipulation.hpp>
#include <diagnostic_msgs/DiagnosticStatus.h>
#include <std_msgs/Float32MultiArray.h>
#include <boost/regex.hpp>
#include <string>
#include <sstream>