| 67 | double last_image_time = -1; |
| 68 | |
| 69 | void new_sequence() |
| 70 | { |
| 71 | printf("new sequence\n"); |
| 72 | sequence++; |
| 73 | printf("sequence cnt %d \n", sequence); |
| 74 | if (sequence > 5) |
| 75 | { |
| 76 | ROS_WARN("only support 5 sequences since it's boring to copy code for more sequences."); |
| 77 | ROS_BREAK(); |
| 78 | } |
| 79 | posegraph.posegraph_visualization->reset(); |
| 80 | posegraph.publish(); |
| 81 | m_buf.lock(); |
| 82 | while(!image_buf.empty()) |
| 83 | image_buf.pop(); |
| 84 | while(!point_buf.empty()) |
| 85 | point_buf.pop(); |
| 86 | while(!pose_buf.empty()) |
| 87 | pose_buf.pop(); |
| 88 | while(!odometry_buf.empty()) |
| 89 | odometry_buf.pop(); |
| 90 | m_buf.unlock(); |
| 91 | } |
| 92 | |
| 93 | void image_callback(const sensor_msgs::ImageConstPtr &image_msg) |
| 94 | { |
no test coverage detected