[WIP] add test code for jsk-ros-pkg#508

k-okada · Mar 1, 2017 · 555752f · 555752f
1 parent 2e89c48
commit 555752f
Show file tree

Hide file tree

Showing 4 changed files with 31 additions and 0 deletions.
diff --git a/roseus/msg/TestName.msg b/roseus/msg/TestName.msg
@@ -0,0 +1 @@
+roseus/StringStamped name
diff --git a/roseus/test/test-name-pub.l b/roseus/test/test-name-pub.l
@@ -0,0 +1,16 @@
+#!/usr/bin/env roseus
+
+(ros::load-ros-manifest "roseus")
+
+(ros::roseus "test_name_pub")
+(ros::advertise "test_name" roseus::TestName)
+(ros::rate 1)
+(setq i 0)
+(while (ros::ok)
+  (setq ss (instance roseus::StringStamped :init :data (format nil "test ~A" (incf i))))
+  (setq msg (instance roseus::TestName :init :name ss))
+  (ros::ros-info "pub ~A" msg)
+  (ros::publish "test_name" msg)
+  (ros::sleep)
+  (ros::spin-once))
+
diff --git a/roseus/test/test-name-sub.l b/roseus/test/test-name-sub.l
@@ -0,0 +1,8 @@
+#!/usr/bin/env roseus
+
+(ros::load-ros-manifest "roseus")
+
+(ros::roseus "test_name_sub")
+(ros::subscribe "test_name" roseus::TestName #'(lambda (msg) (ros::ros-info "sub ~A" msg)))
+(ros::spin)
+
diff --git a/roseus/test/test-name.test b/roseus/test/test-name.test
@@ -0,0 +1,6 @@
+<launch>
+  <node name="test_name_pub" pkg="roseus" type="test-name-pub.l"
+        output="screen" />
+  <node name="test_name_sub" pkg="roseus" type="test-name-sub.l"
+        output="screen" />
+</launch>