Changeset 2629 for GTP/trunk/Lib/Vis/Preprocessing/src/RayCaster.cpp

Timestamp:

01/23/08 00:21:50 (16 years ago)

Author:

bittner

Message:

commit after merge with vlastimil

File:

• GTP/trunk/Lib/Vis/Preprocessing/src/RayCaster.cpp (modified) (3 diffs)

GTP/trunk/Lib/Vis/Preprocessing/src/RayCaster.cpp

@@ -5 +5 @@
 #include "ViewCellsManager.h"
 
+#include <cassert>
 
 namespace GtpVisibilityPreprocessor {
@@ -178 +179 @@
   //const int batchsize = 16384;
   const int batchsize = 8192;
-  // const int batchsize = 1024;
   //const int batchsize = 128;
 
@@ -238 +238 @@
 }
   
+
+void
+RayCaster::SortRays2(SimpleRayContainer &rays)
+{
+  AxisAlignedBox3 box =
+        mPreprocessor.mViewCellsManager->GetViewSpaceBox();
+
+  const float sizeBox = Magnitude(box.Diagonal());
+  // This is some size of the 
+  const float sizeDir = 0.2f * sizeBox;
+  
+  float b[12]={
+    box.Min().x,
+    box.Min().y,
+    box.Min().z,
+    -sizeDir,
+    -sizeDir,
+    -sizeDir,
+    box.Max().x,
+    box.Max().y,
+    box.Max().z,
+    sizeDir,
+    sizeDir,
+    sizeDir
+  };
+
+#if 0
+  static vector<SimpleRay *> pointerArray;
+
+  if (pointerArray.size()!=rays.size()) {
+        // realloc the pointerarray
+        pointerArray.resize(rays.size());
+  }
+
+  // init pointer array
+  SimpleRay *p = &pointerArray[0];
+  for (i=0; i < rays.size(); i++, p++)
+        pointerArray[i] = p;
+#endif
+  
+  _SortRays2(rays, 0, (int)rays.size()-1, 0, b);
+
+  return;
+}
                                         
+void
+RayCaster::_SortRays2(SimpleRayContainer &rays,
+                      const int l,
+                      const int r,
+                      const int depth,
+                      float box[12])
+{
+  // pick-up a pivot
+  int axis;
+  
+  float maxDiff = -1.0f;
+  // get the largest axis
+  int offset = 0;
+  int i;
+
+  //const int batchsize = 16384;
+  //const int batchsize = 8192;
+  const int batchsize = 128;
+
+  //if (r - l < 16*batchsize)
+  //    offset = 3;
+        
+  //  if (depth%2==0)
+  //    offset = 3;
+  
+  for (i=offset; i < offset + 6; i++) {
+    float diff = box[i + 6] - box[i];
+    assert(diff >= 0.f);
+    if (diff > maxDiff) {
+      // Find the maximum
+      maxDiff = diff;
+      axis = i;
+    }
+  }
+
+  //  cout<<depth<<" "<<axis<<" "<<l<<" "<<r<<endl;
+  
+  i=l;
+  int j=r;
+
+  float x = (box[axis] + box[axis+6])*0.5f;
+  //  float x = rays[(l+r)/2].GetParam(axis);
+  do {
+        while(i<j && rays[i].GetParam(axis) < x)
+          i++;
+        while(i<j && x < rays[j].GetParam(axis))
+          j--;
+        
+        if (i <= j) {
+          swap(rays[i], rays[j]);
+          i++;
+          j--;
+        }
+  } while (i<=j);
+
+  
+  if (l + batchsize < j ) {
+        // set new max
+        float save = box[axis+6];
+        box[axis+6] = x;
+        _SortRays2(rays, l, j, depth+1, box);
+        box[axis+6] = save;
+  } else {
+        //      for (int k=0; k < 6; k++)
+        //        cout<<k<<" "<<box[k]<<" - "<<box[k+6]<<endl;
+  }
+  
+  if (i + batchsize < r) {
+    // set new min
+    box[axis] = x;
+    _SortRays2(rays, i, r, depth+1, box);
+  } else {
+        //      for (int k=0; k < 6; k++)
+        //        cout<<k<<" "<<box[k]<<" - "<<box[k+6]<<endl;
+  }
+        
+}
+  
+  
 VssRay *RayCaster::RequestRay(const Vector3 &origin, 
                                                           const Vector3 &termination,