#include <GazeboYarpPlugins/WorldInterfaceServer.h>
#include <yarp/os/idl/WireTypes.h>
#include <algorithm>