| 633 | } |
| 634 | |
| 635 | void HGrid::getGridMarker(vector<Eigen::Vector3d>& pts1, vector<Eigen::Vector3d>& pts2) { |
| 636 | pts1.clear(); |
| 637 | pts2.clear(); |
| 638 | |
| 639 | for (auto& grid : grid1_->grid_data_) { |
| 640 | if (!grid.active_) continue; |
| 641 | for (int i = 0; i < 4; ++i) { |
| 642 | pts1.push_back(grid.vertices_[i]); |
| 643 | pts2.push_back(grid.vertices_[(i + 1) % 4]); |
| 644 | } |
| 645 | } |
| 646 | for (auto& grid : grid2_->grid_data_) { |
| 647 | if (!grid.active_) continue; |
| 648 | for (int i = 0; i < 4; ++i) { |
| 649 | pts1.push_back(grid.vertices_[i]); |
| 650 | pts2.push_back(grid.vertices_[(i + 1) % 4]); |
| 651 | } |
| 652 | } |
| 653 | for (auto& pt : pts1) pt[2] = 0.5; |
| 654 | for (auto& pt : pts2) pt[2] = 0.5; |
| 655 | } |
| 656 | |
| 657 | void HGrid::getGridMarker2(vector<Eigen::Vector3d>& pts, vector<string>& texts) { |
| 658 | pts.clear(); |