| 66 | } |
| 67 | |
| 68 | void Scan::transformPoint(pdal::PointRef& pt) const |
| 69 | { |
| 70 | auto x = pt.getFieldAs<double>(pdal::Dimension::Id::X); |
| 71 | auto y = pt.getFieldAs<double>(pdal::Dimension::Id::Y); |
| 72 | auto z = pt.getFieldAs<double>(pdal::Dimension::Id::Z); |
| 73 | |
| 74 | pt.setField(pdal::Dimension::Id::X, x*m_rotation[0][0] + y*m_rotation[0][1] + z*m_rotation[0][2] + m_translation[0]); |
| 75 | pt.setField(pdal::Dimension::Id::Y, x*m_rotation[1][0] + y*m_rotation[1][1] + z*m_rotation[1][2] + m_translation[1]); |
| 76 | pt.setField(pdal::Dimension::Id::Z, x*m_rotation[2][0] + y*m_rotation[2][1] + z*m_rotation[2][2] + m_translation[2]); |
| 77 | } |
| 78 | |
| 79 | std::array<double,3> |
| 80 | Scan::transformPoint(const std::array<double,3> &originalPoint) const |