X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Fgeometry%2Fsurfacepoint.h;h=57a66d1e95f3898bf1f050ed65afa77bf8d89cae;hb=827b227ae53884109b6885ccd1424dda8c0b3725;hp=251964cef854d91469f6ed9c10280534d3519535;hpb=adb812a194961d542dcb0abd61258cbc8723ecd9;p=libs%2Fmath.git

diff --git a/source/geometry/surfacepoint.h b/source/geometry/surfacepoint.h
index 251964c..57a66d1 100644
--- a/source/geometry/surfacepoint.h
+++ b/source/geometry/surfacepoint.h
@@ -1,6 +1,7 @@
 #ifndef MSP_GEOMETRY_SURFACEPOINT_H_
 #define MSP_GEOMETRY_SURFACEPOINT_H_
 
+#include <algorithm>
 #include <msp/linal/vector.h>
 
 namespace Msp {
@@ -14,8 +15,23 @@ struct SurfacePoint
 {
 	LinAl::Vector<T, N> position;
 	LinAl::Vector<T, N> normal;
+	T distance;
 };
 
+template<typename T, unsigned N>
+void sort_points(SurfacePoint<T, N> *points, unsigned size)
+{
+	for(unsigned i=0; i<size; ++i)
+	{
+		unsigned n = i;
+		for(unsigned j=i+1; j<size; ++j)
+			if(points[j].distance<points[n].distance)
+				n = j;
+		if(n!=i)
+			std::swap(points[i], points[n]);
+	}
+}
+
 } // namespace Geometry
 } // namespace Msp