X-Git-Url: https://defiant.homedns.org/gitweb/?p=ros_wild_thumper.git;a=blobdiff_plain;f=scripts%2Fimagefeed.py;fp=scripts%2Fimagefeed.py;h=31a0149942dffc34650c249a35da1f1631dd719f;hp=0000000000000000000000000000000000000000;hb=eef02300bd4b99a11e6a1756f7b8d4e25c6c0908;hpb=73f9b5e5a082dd91b6d96fdddbe953afe4362b9d

diff --git a/scripts/imagefeed.py b/scripts/imagefeed.py
new file mode 100755
index 0000000..31a0149
--- /dev/null
+++ b/scripts/imagefeed.py
@@ -0,0 +1,36 @@
+#!/usr/bin/env python
+# Lucas Walter
+# GNU GPLv3
+# Load an image from disk and publish it repeatedly
+
+import cv2
+import numpy as np
+import rospy
+import sys
+from sensor_msgs.msg import Image
+
+if __name__ == '__main__': 
+    rospy.init_node('image_publish')
+
+    name = sys.argv[1]
+    image = cv2.imread(name)
+    #cv2.imshow("im", image)
+    #cv2.waitKey(5)
+
+    hz = rospy.get_param("~rate", 1)
+    rate = rospy.Rate(hz)
+
+    pub = rospy.Publisher('/test/image', Image, queue_size=1)
+
+    msg = Image()
+    msg.header.stamp = rospy.Time.now()
+    msg.encoding = 'bgr8'
+    msg.height = image.shape[0]
+    msg.width = image.shape[1]
+    msg.step = image.shape[1] * 3
+    msg.data = image.tostring()
+    pub.publish(msg)
+
+    while not rospy.is_shutdown():
+        pub.publish(msg)
+        rate.sleep()