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

diff --git a/source/geometry/surfacepoint.h b/source/geometry/surfacepoint.h
index a5bd794..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 {
@@ -17,6 +18,20 @@ struct SurfacePoint
 	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