Fixed the timing error, seems to be a bug in rosbag or roslaunch