| 287 | } |
| 288 | |
| 289 | KeyFrame* PoseGraph::getKeyFrame(int index) |
| 290 | { |
| 291 | // unique_lock<mutex> lock(m_keyframelist); |
| 292 | list<KeyFrame*>::iterator it = keyframelist.begin(); |
| 293 | for (; it != keyframelist.end(); it++) |
| 294 | { |
| 295 | if((*it)->index == index) |
| 296 | break; |
| 297 | } |
| 298 | if (it != keyframelist.end()) |
| 299 | return *it; |
| 300 | else |
| 301 | return NULL; |
| 302 | } |
| 303 | |
| 304 | int PoseGraph::detectLoop(KeyFrame* keyframe, int frame_index) |
| 305 | { |