import rospy
from sensor_msgs.msg import Image
from std_msgs.msg import String
from cv_bridge import CvBridge
import cv2
import numpy as np
import tensorflow as tf
import classify_image


class RosTensorFlow():
    def __init__(self):
        classify_image.maybe_download_and_extract()
        self._session = tf.Session()
        classify_image.create_graph()
        self._cv_bridge = CvBridge()

        self._sub = rospy.Subscriber('/usb_cam/image_raw', Image, self.callback, queue_size=1)
        self._pub = rospy.Publisher('result', String, queue_size=1)
        self.score_threshold = rospy.get_param('~score_threshold', 0.1)
        self.use_top_k = rospy.get_param('~use_top_k', 5)

    def callback(self, image_msg):
        cv_image = self._cv_bridge.imgmsg_to_cv2(image_msg, "bgr8")
        # copy from
        # classify_image.py
        image_data = cv2.imencode('.jpg', cv_image)[1].tostring()
        # Creates graph from saved GraphDef.
        softmax_tensor = self._session.graph.get_tensor_by_name('softmax:0')
        predictions = self._session.run(
            softmax_tensor, {'DecodeJpeg/contents:0': image_data})
        predictions = np.squeeze(predictions)
        # Creates node ID --> English string lookup.
        node_lookup = classify_image.NodeLookup()
        top_k = predictions.argsort()[-self.use_top_k:][::-1]
        for node_id in top_k:
            human_string = node_lookup.id_to_string(node_id)
            score = predictions[node_id]
            if score > self.score_threshold:
                rospy.loginfo('%s (score = %.5f)' % (human_string, score))
                self._pub.publish(human_string)

    def main(self):
        rospy.spin()

if __name__ == '__main__':
    classify_image.setup_args()
    rospy.init_node('rostensorflow')
    tensor = RosTensorFlow()
    tensor.main()

[(47, 'classify_image.setup_args', 'classify_image.setup_args', ([], {}), False, 'import classify_image\n'), (48, 'rospy.init_node', 'rospy.init_node', (['"""rostensorflow"""'], {}), False, 'import rospy\n'), (13, 'classify_image.maybe_download_and_extract', 'classify_image.maybe_download_and_extract', ([], {}), False, 'import classify_image\n'), (14, 'tensorflow.Session', 'tf.Session', ([], {}), True, 'import tensorflow as tf\n'), (15, 'classify_image.create_graph', 'classify_image.create_graph', ([], {}), False, 'import classify_image\n'), (16, 'cv_bridge.CvBridge', 'CvBridge', ([], {}), False, 'from cv_bridge import CvBridge\n'), (18, 'rospy.Subscriber', 'rospy.Subscriber', (['"""/usb_cam/image_raw"""', 'Image', 'self.callback'], {'queue_size': '(1)'}), False, 'import rospy\n'), (19, 'rospy.Publisher', 'rospy.Publisher', (['"""result"""', 'String'], {'queue_size': '(1)'}), False, 'import rospy\n'), (20, 'rospy.get_param', 'rospy.get_param', (['"""~score_threshold"""', '(0.1)'], {}), False, 'import rospy\n'), (21, 'rospy.get_param', 'rospy.get_param', (['"""~use_top_k"""', '(5)'], {}), False, 'import rospy\n'), (32, 'numpy.squeeze', 'np.squeeze', (['predictions'], {}), True, 'import numpy as np\n'), (34, 'classify_image.NodeLookup', 'classify_image.NodeLookup', ([], {}), False, 'import classify_image\n'), (44, 'rospy.spin', 'rospy.spin', ([], {}), False, 'import rospy\n'), (40, 'rospy.loginfo', 'rospy.loginfo', (["('%s (score = %.5f)' % (human_string, score))"], {}), False, 'import rospy\n'), (27, 'cv2.imencode', 'cv2.imencode', (['""".jpg"""', 'cv_image'], {}), False, 'import cv2\n')]