7 #ifndef OPENVDB_TOOLS_GRIDTRANSFORMER_HAS_BEEN_INCLUDED
8 #define OPENVDB_TOOLS_GRIDTRANSFORMER_HAS_BEEN_INCLUDED
19 #include <tbb/blocked_range.h>
20 #include <tbb/parallel_reduce.h>
52 template<
typename Sampler,
typename Interrupter,
typename Gr
idType>
54 resampleToMatch(
const GridType& inGrid, GridType& outGrid, Interrupter& interrupter);
77 template<
typename Sampler,
typename Gr
idType>
90 template<
typename Sampler,
typename TreeT>
94 using ValueT =
typename TreeT::ValueType;
100 mBBox(b.
min().asVec3d(), b.
max().asVec3d()), mVal(tileVal), mActive(on), mEmpty(false)
102 mBBox.expand(-this->radius());
103 mEmpty = mBBox.empty();
108 if (!mEmpty && mBBox.isInside(inCoord)) { result = mVal;
return mActive; }
109 return Sampler::sample(inTree, inCoord, result);
121 template<
typename TreeT>
129 template<
typename TreeT>
182 template<
typename InterrupterType>
void setInterrupter(InterrupterType&);
184 template<
typename Sampler,
typename Gr
idT,
typename Transformer>
185 void transformGrid(
const Transformer&,
186 const GridT& inGrid, GridT& outGrid)
const;
189 template<
typename Sampler,
typename Gr
idT,
typename Transformer>
190 void applyTransform(
const Transformer&,
const GridT& inGrid, GridT& outGrid)
const;
192 bool interrupt()
const {
return mInterrupt && mInterrupt(); }
195 template<
typename Sampler,
typename InTreeT,
typename OutTreeT,
typename Transformer>
196 static void transformBBox(
const Transformer&,
const CoordBBox& inBBox,
197 const InTreeT& inTree, OutTreeT& outTree,
const InterruptFunc&,
200 template<
typename Sampler,
typename TreeT,
typename Transformer>
201 class RangeProcessor;
203 bool mThreaded, mTransformTiles;
204 InterruptFunc mInterrupt;
239 const Vec3R& translate,
240 const std::string& xformOrder =
"tsr",
241 const std::string& rotationOrder =
"zyx");
249 template<
class Sampler,
class Gr
idT>
250 void transformGrid(
const GridT& inGrid, GridT& outGrid)
const;
253 struct MatrixTransform;
257 const std::string& xformOrder,
const std::string& rotOrder);
261 Mat4R mTransform, mPreScaleTransform, mPostScaleTransform;
268 namespace local_util {
294 const bool hasUniformScale = unsignedScale.
eq(
math::Vec3<T>(unsignedScale[0]));
296 bool hasRotation =
false;
297 bool validDecomposition =
false;
303 for (
size_t n = 0; n < 8; ++n) {
305 n & 0x1 ? -unsignedScale.
x() : unsignedScale.
x(),
306 n & 0x2 ? -unsignedScale.
y() : unsignedScale.
y(),
307 n & 0x4 ? -unsignedScale.
z() : unsignedScale.
z());
310 const math::Mat3<T> mat = xform * math::scale<math::Mat3<T> >(signedScale).inverse();
311 if (mat.
det() < T(0.0))
continue;
316 math::rotation<math::Mat3<T> >(
math::Vec3<T>(0, 0, 1), tmpAngle.
z()) *
321 if (xform.
eq(rebuild)) {
323 const T maxAngle =
std::max(std::abs(tmpAngle[0]),
324 std::max(std::abs(tmpAngle[1]), std::abs(tmpAngle[2])));
326 if (!(minAngle < maxAngle)) {
333 validDecomposition =
true;
335 if (hasUniformScale || !hasRotation) {
343 if (!validDecomposition) {
347 if (hasRotation && !hasUniformScale) {
393 mIsAffine(mAXform.isLinear() && mBXform.isLinear()),
394 mIsIdentity(mIsAffine && mAXform == mBXform)
403 return mBXform.worldToIndex(mAXform.indexToWorld(pos));
408 return mAXform.worldToIndex(mBXform.indexToWorld(pos));
416 const bool mIsAffine;
417 const bool mIsIdentity;
427 template<
typename Sampler,
typename Interrupter,
typename Gr
idType>
431 ABTransform xform(inGrid.transform(), outGrid.transform());
433 if (Sampler::consistent() && xform.
isIdentity()) {
436 outGrid.setTree(inGrid.tree().copy());
442 ( xform.
getB().
baseMap()->getAffineMap()->getMat4().inverse() );
460 template<
typename ValueType>
462 static ValueType
eval(
const ValueType& background,
const Vec3d& voxelSize)
465 ValueType result(background * (1.0 / voxelSize[0]));
480 template<
typename Sampler,
typename Interrupter,
typename Gr
idType>
487 if (inGrid.constTransform() == outGrid.constTransform()) {
490 outGrid.setTree(inGrid.tree().copy());
496 using ValueT =
typename GridType::ValueType;
499 const ValueT halfWidth = outIsLevelSet
503 typename GridType::Ptr tempGrid;
505 tempGrid = doLevelSetRebuild(inGrid, zeroVal<ValueT>(),
506 halfWidth, halfWidth,
507 &outGrid.constTransform(), &interrupter);
515 outGrid.setTree(tempGrid->treePtr());
521 doResampleToMatch<Sampler>(inGrid, outGrid, interrupter);
525 template<
typename Sampler,
typename Gr
idType>
530 resampleToMatch<Sampler>(inGrid, outGrid, interrupter);
538 GridTransformer::GridTransformer(
const Mat4R& xform):
542 mPreScaleTransform(
Mat4R::identity()),
543 mPostScaleTransform(
Mat4R::identity())
549 init(mPivot,
scale, rotate, translate,
"rst",
"zyx");
558 const std::string& xformOrder,
const std::string& rotOrder):
561 mPreScaleTransform(
Mat4R::identity()),
562 mPostScaleTransform(
Mat4R::identity())
564 init(
pivot,
scale, rotate, translate, xformOrder, rotOrder);
572 GridTransformer::init(
575 const std::string& xformOrder,
const std::string& rotOrder)
577 if (xformOrder.size() != 3) {
580 if (rotOrder.size() != 3) {
590 for (
int i = 0; i < 3; ++i) {
591 double s = std::fabs(
scale(i));
593 mMipLevels(i) = int(std::floor(-std::log(s)/std::log(2.0)));
594 scaleRemainder(i) =
scale(i) * (1 << mMipLevels(i));
603 mTransform = mPreScaleTransform = mPostScaleTransform =
Mat4R::identity();
604 Mat4R* remainder = &mPostScaleTransform;
605 int rpos, spos, tpos;
606 rpos = spos = tpos = 3;
607 for (
int ix = 2; ix >= 0; --ix) {
608 switch (xformOrder[ix]) {
613 remainder->preTranslate(
pivot);
615 int xpos, ypos, zpos;
616 xpos = ypos = zpos = 3;
617 for (
int ir = 2; ir >= 0; --ir) {
618 switch (rotOrder[ir]) {
638 if (xpos > 2 || ypos > 2 || zpos > 2) {
639 OPENVDB_THROW(ValueError,
"invalid rotation order (" + rotOrder +
")");
643 remainder->preTranslate(-
pivot);
652 remainder->preTranslate(
pivot);
653 remainder->preScale(scaleRemainder);
654 remainder->preTranslate(-
pivot);
655 remainder = &mPreScaleTransform;
661 remainder->preTranslate(translate);
667 if (tpos > 2 || rpos > 2 || spos > 2) {
668 OPENVDB_THROW(ValueError,
"invalid transform order (" + xformOrder +
")");
676 template<
typename InterrupterType>
685 template<
typename Sampler,
typename Gr
idT,
typename Transformer>
688 const GridT& inGrid, GridT& outGrid)
const
691 applyTransform<Sampler>(xform, inGrid, outGrid);
695 template<
class Sampler,
class Gr
idT>
704 applyTransform<Sampler>(xform, inGrid, outGrid);
707 bool firstPass =
true;
708 const typename GridT::ValueType background = inGrid.background();
709 typename GridT::Ptr tempGrid = GridT::create(background);
716 applyTransform<Sampler>(xform, inGrid, *tempGrid);
721 Vec3i count = mMipLevels;
722 while (count != Vec3i::zero()) {
726 count.x() ? .5 : 1, count.y() ? .5 : 1, count.z() ? .5 : 1));
733 applyTransform<Sampler>(xform, inGrid, *tempGrid);
737 typename GridT::Ptr destGrid = GridT::create(background);
738 applyTransform<Sampler>(xform, *tempGrid, *destGrid);
739 tempGrid.swap(destGrid);
748 applyTransform<Sampler>(xform, *tempGrid, outGrid);
750 outGrid.setTree(tempGrid->treePtr());
759 template<
class Sampler,
class TreeT,
typename Transformer>
760 class GridResampler::RangeProcessor
763 using LeafIterT =
typename TreeT::LeafCIter;
764 using TileIterT =
typename TreeT::ValueAllCIter;
770 RangeProcessor(
const Transformer& xform,
const CoordBBox& b,
const TreeT& inT, TreeT& outT):
771 mIsRoot(true), mXform(xform), mBBox(b),
772 mInTree(inT), mOutTree(&outT), mInAcc(mInTree), mOutAcc(*mOutTree)
775 RangeProcessor(
const Transformer& xform,
const CoordBBox& b,
const TreeT& inTree):
776 mIsRoot(false), mXform(xform), mBBox(b),
777 mInTree(inTree), mOutTree(new TreeT(inTree.background())),
778 mInAcc(mInTree), mOutAcc(*mOutTree)
781 ~RangeProcessor() {
if (!mIsRoot)
delete mOutTree; }
784 RangeProcessor(RangeProcessor& other, tbb::split):
786 mXform(other.mXform),
788 mInTree(other.mInTree),
789 mOutTree(new TreeT(mInTree.background())),
792 mInterrupt(other.mInterrupt)
795 void setInterrupt(
const InterruptFunc& f) { mInterrupt = f; }
798 void operator()(LeafRange& r)
802 LeafIterT i = r.iterator();
803 CoordBBox bbox(i->origin(), i->origin() + Coord(i->dim()));
804 if (!mBBox.empty()) {
811 transformBBox<Sampler>(mXform, bbox, mInAcc, mOutAcc, mInterrupt);
817 void operator()(TileRange& r)
822 TileIterT i = r.iterator();
824 if (!i.isTileValue())
continue;
828 i.getBoundingBox(bbox);
829 if (!mBBox.empty()) {
840 internal::TileSampler<Sampler, InTreeAccessor>
841 sampler(bbox, i.getValue(), i.isValueOn());
842 transformBBox(mXform, bbox, mInAcc, mOutAcc, mInterrupt, sampler);
848 void join(RangeProcessor& other)
850 if (!
interrupt()) mOutTree->merge(*other.mOutTree);
854 bool interrupt()
const {
return mInterrupt && mInterrupt(); }
859 const TreeT& mInTree;
861 InTreeAccessor mInAcc;
862 OutTreeAccessor mOutAcc;
870 template<
class Sampler,
class Gr
idT,
typename Transformer>
873 const GridT& inGrid, GridT& outGrid)
const
875 using TreeT =
typename GridT::TreeType;
876 const TreeT& inTree = inGrid.tree();
877 TreeT& outTree = outGrid.tree();
879 using RangeProc = RangeProcessor<Sampler, TreeT, Transformer>;
881 const GridClass gridClass = inGrid.getGridClass();
888 RangeProc proc(xform,
CoordBBox(), inTree, outTree);
889 proc.setInterrupt(mInterrupt);
891 typename RangeProc::TileIterT tileIter = inTree.cbeginValueAll();
892 tileIter.setMaxDepth(tileIter.getLeafDepth() - 1);
893 typename RangeProc::TileRange tileRange(tileIter);
896 tbb::parallel_reduce(tileRange, proc);
906 clipBBox = inGrid.evalActiveVoxelBoundingBox();
911 RangeProc proc(xform, clipBBox, inTree, outTree);
912 proc.setInterrupt(mInterrupt);
914 typename RangeProc::LeafRange leafRange(inTree.cbeginLeaf());
917 tbb::parallel_reduce(leafRange, proc);
934 template<
class Sampler,
class InTreeT,
class OutTreeT,
class Transformer>
936 GridResampler::transformBBox(
937 const Transformer& xform,
939 const InTreeT& inTree,
941 const InterruptFunc& interrupt,
944 using ValueT =
typename OutTreeT::ValueType;
950 inRMax(bbox.
max().
x()+1, bbox.
max().
y()+1, bbox.
max().
z()+1),
953 for (
int i = 0; i < 8; ++i) {
955 i & 1 ? inRMax.x() : inRMin.x(),
956 i & 2 ? inRMax.y() : inRMin.y(),
957 i & 4 ? inRMax.z() : inRMin.z());
965 if (!xform.isAffine()) {
970 int &x = outXYZ.
x(), &y = outXYZ.
y(), &z = outXYZ.
z();
971 for (x = outMin.x(); x <= outMax.x(); ++x) {
974 for (y = outMin.y(); y <= outMax.y(); ++y) {
977 for (z = outMin.z(); z <= outMax.z(); ++z) {
979 inXYZ = xform.invTransform(xyz);
981 if (sampler.
sample(inTree, inXYZ, result)) {
982 outTree.setValueOn(outXYZ, result);
985 if (!outTree.isValueOn(outXYZ)) {
986 outTree.setValueOff(outXYZ, result);
996 translation = xform.invTransform(
Vec3R(0, 0, 0)),
997 deltaX = xform.invTransform(
Vec3R(1, 0, 0)) - translation,
998 deltaY = xform.invTransform(
Vec3R(0, 1, 0)) - translation,
999 deltaZ = xform.invTransform(
Vec3R(0, 0, 1)) - translation;
1002 const Vec3R dummy = deltaX;
1010 Vec3R inStartX = xform.invTransform(
Vec3R(outMin));
1012 int &x = outXYZ.
x(), &y = outXYZ.y(), &z = outXYZ.z();
1013 for (x = outMin.x(); x <= outMax.x(); ++x, inStartX += deltaX) {
1015 Vec3R inStartY = inStartX;
1016 for (y = outMin.y(); y <= outMax.y(); ++y, inStartY += deltaY) {
1018 Vec3R inXYZ = inStartY;
1019 for (z = outMin.z(); z <= outMax.z(); ++z, inXYZ += deltaZ) {
1021 if (sampler.
sample(inTree, inXYZ, result)) {
1022 outTree.setValueOn(outXYZ, result);
1025 if (!outTree.isValueOn(outXYZ)) {
1026 outTree.setValueOff(outXYZ, result);
1039 #endif // OPENVDB_TOOLS_GRIDTRANSFORMER_HAS_BEEN_INCLUDED