| 234 | } |
| 235 | |
| 236 | size_t |
| 237 | Tracker::appendToPointCloud(pcl::PointCloud<pcl::PointXYZRGB>::Ptr& pointcloud, size_t starting_index, size_t max_size) |
| 238 | { |
| 239 | for(size_t i = 0; i < tracks_.size() && pointcloud->size() < max_size; i++) |
| 240 | { |
| 241 | pcl::PointXYZRGB point; |
| 242 | pointcloud->push_back(point); |
| 243 | } |
| 244 | |
| 245 | for(std::list<open_ptrack::tracking::Track*>::iterator it = tracks_.begin(); it != tracks_.end(); it++) |
| 246 | { |
| 247 | open_ptrack::tracking::Track* t = *it; |
| 248 | if(t->getPointXYZRGB(pointcloud->points[starting_index])) |
| 249 | starting_index = (starting_index + 1) % max_size; |
| 250 | |
| 251 | } |
| 252 | return starting_index; |
| 253 | } |
| 254 | |
| 255 | /************************ protected methods ************************/ |
| 256 |
no test coverage detected