import rosbag
import os,sys
import cv2
from cv_bridge import CvBridge
color_t=[]
rbag = rosbag.Bag('./image_segment_rgb.bag')
count_color=0
count_segmentation=0
for topic,msg,t in rbag.read_messages():
#print "------------topic\n",topic
#print "----------msg\n",msg
#print "-------------t\n",t
if 'image_color' in topic:
bridge = CvBridge()
cv_img = bridge.imgmsg_to_cv2(msg, 'bgr8')
cv2.imwrite("./image_color/{}.bmp".format(t), cv_img)
color_t.append(t)
print len(set(color_t))
print "--------------ok--------------------------"
for topic,msg,t in rbag.read_messages():
if 'image_segmentation' in topic and t in color_t :
bridge = CvBridge()
cv_img = bridge.imgmsg_to_cv2(msg, 'bgr8')
cv2.imwrite("./image_segmentation/{}.bmp".format(t), cv_img)
rbag.close()