append photos

Author: ankxyz

core

@@ -0,0 +1,23 @@
+import rospy
+from sensor_msgs.msg import Image
+import sys
+sys.path.insert(1, '/usr/local/lib/python3.5/dist-packages')
+
+import cv2
+import ros_numpy
+
+if __name__ == '__main__':
+    rospy.init_node('smile_test')
+
+    photo_folder = 'photos'
+
+    pub = rospy.Publisher('/vision_camera_capture/image', Image, queue_size=1)
+    
+    while True:
+        ans = input('image name: ')
+        try:
+            frame = cv2.imread(photo_folder + '/' + ans)
+            img = ros_numpy.msgify(Image, frame, encoding='rgb8')
+            pub.publish(img)
+        except Exception as e:
+            print('photo not found or ', str(e))

photos/6.jpg

@@ -56,7 +56,7 @@ def callback_photo(data: Image):
                 print('image saving error: ', str(e))
 
 
-        get_im_sub = rospy.Subscriber('/vision_face_tracking/face_image', Image, lock_recognize.callback)
+        get_im_sub = rospy.Subscriber('/vision_face_tracking/face_image', Image, callback_photo)
         time.sleep(1)
         get_im_sub.unregister()
 
@@ -85,9 +85,9 @@ def control_head():
             hp.move_v_angle(-step)
         elif ans == 's':
             hp.move_v_angle(step)
-        elif ans == 'l':
+        elif ans == 'a':
             hp.move_h_angle(step)
-        elif ans == 'r':
+        elif ans == 'd':
             hp.move_h_angle(-step)
         else:
             pass

photos/7.jpg

@@ -1,5 +1,6 @@
 #!/usr/bin/env python3
-
+import sys
+sys.path.insert(1, '/usr/local/lib/python3.5/dist-packages')
 import cv2
 
 if __name__ == '__main__':