| 111 | |
| 112 | |
| 113 | void Pointcloud::transformAbsolute(pose6d transform) { |
| 114 | |
| 115 | // undo previous transform, then apply current transform |
| 116 | pose6d transf = current_inv_transform * transform; |
| 117 | |
| 118 | for (unsigned int i=0; i<points.size(); i++) { |
| 119 | points[i] = transf.transform(points[i]); |
| 120 | } |
| 121 | |
| 122 | current_inv_transform = transform.inv(); |
| 123 | } |
| 124 | |
| 125 | |
| 126 | void Pointcloud::rotate(double roll, double pitch, double yaw) { |
no test coverage detected