diff --git a/infuse-waypoint-publisher/DESCR b/infuse-waypoint-publisher/DESCR
new file mode 100644
index 0000000000000000000000000000000000000000..3eed3b2705cc04df98ac6ba500871d489d186c8e
--- /dev/null
+++ b/infuse-waypoint-publisher/DESCR
@@ -0,0 +1 @@
+GenoM3 module that dump a pose file into a ros asn1 path port
diff --git a/infuse-waypoint-publisher/Makefile b/infuse-waypoint-publisher/Makefile
new file mode 100644
index 0000000000000000000000000000000000000000..98cb9ef269162a3725117a6f995581ef2cf1ae45
--- /dev/null
+++ b/infuse-waypoint-publisher/Makefile
@@ -0,0 +1,64 @@
+# robotpkg Makefile for:	robots/infuse_bitstream_sink-genom3
+# Created:			Ellon Paiva Mendes on Thu, 16 Aug 2018
+#
+
+NAME=			infuse_waypoint_publisher-genom3
+VERSION=		0.1
+
+DISTNAME=		${NAME}-${VERSION}
+CATEGORIES=		robots
+MASTER_SITES=		http://homepages.laas.fr/pnarvor/infuse/
+MASTER_REPOSITORY=	git ssh://git@redmine.laas.fr/laas/users/simon/infuse-waypoint-publisher.git
+
+MAINTAINER=		laas-infuse@laas.fr
+COMMENT=		GenoM3 module that dump a pose file into a ros asn1 path port
+LICENSE=		isc
+
+include ../../architecture/genom3/module.mk
+
+# For InFuse we use ROS, so keep these options enabled by default
+PKG_SUGGESTED_OPTIONS+=		ros-client-c ros-client-ros ros-server
+
+# # This WAS SUPPOSED TO fix the double dependency on std_msgs in the
+# # generated package.xml files. This does not work here probably because
+# # PKG_OPTIONS here is empty. This should probably go in a 'define' to be
+# # expanded later, but I don't know how to do it. :(
+# ifneq (,$(filter ros-client-c,${PKG_OPTIONS}))
+# 	SUBST_CLASSES+=							fix-ros-client-c-depends
+# 	SUBST_STAGE.fix-ros-client-c-depends=	pre-install
+# 	SUBST_MESSAGE.fix-ros-client-c-depends=	Fixing repeated dependency on std_msgs for option ros-client-c
+# 	SUBST_FILES.fix-ros-client-c-depends=	../templates/ros/client/c/*/package.xml
+# 	SUBST_SED.fix-ros-client-c-depends=		-e '0,/<depend>std_msgs<\/depend>/! s/<depend>std_msgs<\/depend>//'
+# endif
+# ifneq (,$(filter ros-client-ros,${PKG_OPTIONS}))
+# 	SUBST_CLASSES+=								fix-ros-client-ros-depends
+# 	SUBST_STAGE.fix-ros-client-ros-depends=		pre-install
+# 	SUBST_MESSAGE.fix-ros-client-ros-depends=	Fixing repeated dependency on std_msgs for option ros-client-ros
+# 	SUBST_FILES.fix-ros-client-ros-depends=		../templates/ros/client/ros/*/package.xml
+# 	SUBST_SED.fix-ros-client-ros-depends=		-e '0,/<depend>std_msgs<\/depend>/! s/<depend>std_msgs<\/depend>//'
+# endif
+# ifneq (,$(filter ros-server,${PKG_OPTIONS}))
+# 	SUBST_CLASSES+=							fix-ros-server-depends
+# 	SUBST_STAGE.fix-ros-server-depends=		pre-install
+# 	SUBST_MESSAGE.fix-ros-server-depends=	Fixing repeated dependency on std_msgs for option ros-server
+# 	SUBST_FILES.fix-ros-server-depends=		../templates/ros/server/*/package.xml
+# 	SUBST_SED.fix-ros-server-depends=		-e '0,/<depend>std_msgs<\/depend>/! s/<depend>std_msgs<\/depend>//'
+# endif
+
+# Dirty hack to fix the repeated dependency because the solution commented
+# above didn't work. The installation of this package probably going to fail
+# if not compiled with ROS options
+SUBST_CLASSES+=							fix-std-msgs-depends
+SUBST_STAGE.fix-std-msgs-depends=		pre-install
+SUBST_MESSAGE.fix-std-msgs-depends=		Fixing repeated dependency on std_msgs
+SUBST_FILES.fix-std-msgs-depends=		../templates/ros/server/*/package.xml
+SUBST_FILES.fix-std-msgs-depends+=		../templates/ros/client/*/*/package.xml
+SUBST_SED.fix-std-msgs-depends=			-e '0,/<depend>std_msgs<\/depend>/! s/<depend>std_msgs<\/depend>//'
+
+include ../../interfaces/openrobots-idl/depend.mk
+include ../../wip/infuse-asn1-types/depend.mk
+include ../../wip/infuse-asn1-conversions/depend.mk
+include ../../wip/infuse-idl/depend.mk
+include ../../robots/rmp-libs/depend.mk
+include ../../mk/language/c.mk
+include ../../mk/robotpkg.mk
diff --git a/infuse-waypoint-publisher/PLIST b/infuse-waypoint-publisher/PLIST
new file mode 100644
index 0000000000000000000000000000000000000000..b0caa9b4054c3cc4f3bf6cfdb955a2980a6387d2
--- /dev/null
+++ b/infuse-waypoint-publisher/PLIST
@@ -0,0 +1,10 @@
+@comment Tue Aug 28 12:42:33 CEST 2018
+${PLIST.ros-server}bin/${GENOM_MODULE}-ros
+${PLIST.codels}lib/lib${GENOM_MODULE}_codels.la
+${PLIST.codels}lib/lib${GENOM_MODULE}_codels.so
+${PLIST.codels}lib/lib${GENOM_MODULE}_codels-${PKGVERSION}.so
+${PLIST.codels}lib/pkgconfig/${GENOM_MODULE}-genom3.pc
+${PLIST.codels}share/doc/${GENOM_MODULE}-genom3/README.adoc
+${PLIST.codels}share/doc/${GENOM_MODULE}-genom3/README.html
+${PLIST.codels}share/idl/${GENOM_MODULE}/${GENOM_MODULE}.gen
+@comment includes architecture/genom3/PLIST.templates
diff --git a/infuse-waypoint-publisher/distinfo b/infuse-waypoint-publisher/distinfo
new file mode 100644
index 0000000000000000000000000000000000000000..6c0ae816932b62954b2786841bd5fe039e5937ab
--- /dev/null
+++ b/infuse-waypoint-publisher/distinfo
@@ -0,0 +1,3 @@
+SHA1 (infuse_waypoint_publisher-genom3-0.1.tar.gz) = a847ccd989dc56137f88905c9ee01e4bef77a06c
+RMD160 (infuse_waypoint_publisher-genom3-0.1.tar.gz) = aeaf0c19484ee29edf61ca7d7ebc51fe337255ec
+Size (infuse_waypoint_publisher-genom3-0.1.tar.gz) = 377791 bytes