开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 图形图像 > GIS编程 > 查看源码
CoordinateTransformTests.cs
资源名称：SharpMap-20976.zip　[点击查看]
上传用户：sex100000
上传日期：2013-11-09
资源大小：1377k
文件大小：19k
源码类别：

GIS编程

开发平台：

C#

CoordinateTransformTests.cs：源码内容
  1. using System;
  2. using System.Collections.Generic;
  3. using System.Text;
  5. using SharpMap.Geometries;
  6. using SharpMap.CoordinateSystems;
  7. using SharpMap.CoordinateSystems.Transformations;
  9. using NUnit.Framework;
  11. namespace UnitTests
  12. {
  13. [TestFixture]
  14. public class CoordinateTransformTests
  15. {
  16. [Test]
  17. public void TestAlbersProjection()
  18. {
  19. CoordinateSystemFactory cFac = new SharpMap.CoordinateSystems.CoordinateSystemFactory();
  21. IEllipsoid ellipsoid = cFac.CreateFlattenedSphere("Clarke 1866", 6378206.4, 294.9786982138982, LinearUnit.USSurveyFoot);
  23. IHorizontalDatum datum = cFac.CreateHorizontalDatum("Clarke 1866", DatumType.HD_Geocentric, ellipsoid, null);
  24. IGeographicCoordinateSystem gcs = cFac.CreateGeographicCoordinateSystem("Clarke 1866", AngularUnit.Degrees, datum,
  25. PrimeMeridian.Greenwich, new AxisInfo("Lon", AxisOrientationEnum.East),
  26. new AxisInfo("Lat", AxisOrientationEnum.North));
  27.             //System.Collections.ObjectModel.Collection<ProjectionParameter> parameters = new System.Collections.ObjectModel.Collection<ProjectionParameter>(5);
  28.             System.Collections.ObjectModel.Collection<ProjectionParameter> parameters = new System.Collections.ObjectModel.Collection<ProjectionParameter>();
  29. parameters.Add(new ProjectionParameter("central_meridian", -96));
  30. parameters.Add(new ProjectionParameter("latitude_of_origin", 23));
  31. parameters.Add(new ProjectionParameter("standard_parallel_1", 29.5));
  32. parameters.Add(new ProjectionParameter("standard_parallel_2", 45.5));
  33. parameters.Add(new ProjectionParameter("false_easting", 0));
  34. parameters.Add(new ProjectionParameter("false_northing", 0));
  35. IProjection projection = cFac.CreateProjection("Albers Conical Equal Area", "albers", parameters);
  37. IProjectedCoordinateSystem coordsys = cFac.CreateProjectedCoordinateSystem("Albers Conical Equal Area", gcs, projection, LinearUnit.Metre, new AxisInfo("East", AxisOrientationEnum.East), new AxisInfo("North", AxisOrientationEnum.North));
  39. ICoordinateTransformation trans = new CoordinateTransformationFactory().CreateFromCoordinateSystems(gcs, coordsys);
  41. SharpMap.Geometries.Point pGeo = new SharpMap.Geometries.Point(-75, 35);
  42. SharpMap.Geometries.Point pUtm = trans.MathTransform.Transform(pGeo);
  43. SharpMap.Geometries.Point pGeo2 = trans.MathTransform.Inverse().Transform(pUtm);
  45. SharpMap.Geometries.Point expected = new Point(1885472.7, 1535925);
  46. Assert.IsTrue(ToleranceLessThan(pUtm, expected, 0.05), String.Format("Albers forward transformation outside tolerance, Expected {0}, got {1}", expected.ToString(), pUtm.ToString()));
  47. Assert.IsTrue(ToleranceLessThan(pGeo, pGeo2, 0.0000001), String.Format("Albers reverse transformation outside tolerance, Expected {0}, got {1}", pGeo.ToString(), pGeo2.ToString()));
  48. }
  49. [Test]
  50. public void TestMercator_1SP_Projection()
  51. {
  52. CoordinateSystemFactory cFac = new SharpMap.CoordinateSystems.CoordinateSystemFactory();
  54. IEllipsoid ellipsoid = cFac.CreateFlattenedSphere("Bessel 1840", 6377397.155, 299.15281, LinearUnit.Metre);
  56. IHorizontalDatum datum = cFac.CreateHorizontalDatum("Bessel 1840", DatumType.HD_Geocentric, ellipsoid, null);
  57. IGeographicCoordinateSystem gcs = cFac.CreateGeographicCoordinateSystem("Bessel 1840", AngularUnit.Degrees, datum,
  58. PrimeMeridian.Greenwich, new AxisInfo("Lon", AxisOrientationEnum.East),
  59. new AxisInfo("Lat", AxisOrientationEnum.North));
  60.             //System.Collections.ObjectModel.Collection<ProjectionParameter> parameters = new System.Collections.ObjectModel.Collection<ProjectionParameter>(5);
  61.             System.Collections.ObjectModel.Collection<ProjectionParameter> parameters = new System.Collections.ObjectModel.Collection<ProjectionParameter>();
  62. parameters.Add(new ProjectionParameter("latitude_of_origin", 0));
  63. parameters.Add(new ProjectionParameter("central_meridian", 110));
  64. parameters.Add(new ProjectionParameter("scale_factor", 0.997));
  65. parameters.Add(new ProjectionParameter("false_easting", 3900000));
  66. parameters.Add(new ProjectionParameter("false_northing", 900000));
  67. IProjection projection = cFac.CreateProjection("Mercator_1SP", "Mercator_1SP", parameters);
  69. IProjectedCoordinateSystem coordsys = cFac.CreateProjectedCoordinateSystem("Makassar / NEIEZ", gcs, projection, LinearUnit.Metre, new AxisInfo("East", AxisOrientationEnum.East), new AxisInfo("North", AxisOrientationEnum.North));
  71. ICoordinateTransformation trans = new CoordinateTransformationFactory().CreateFromCoordinateSystems(gcs, coordsys);
  73. SharpMap.Geometries.Point pGeo = new SharpMap.Geometries.Point(120, -3);
  74. SharpMap.Geometries.Point pUtm = trans.MathTransform.Transform(pGeo);
  75. SharpMap.Geometries.Point pGeo2 = trans.MathTransform.Inverse().Transform(pUtm);
  77. SharpMap.Geometries.Point expected = new Point(5009726.58, 569150.82);
  78. Assert.IsTrue(ToleranceLessThan(pUtm, expected, 0.02), String.Format("Mercator_1SP forward transformation outside tolerance, Expected {0}, got {1}", expected.ToString(), pUtm.ToString()));
  79. Assert.IsTrue(ToleranceLessThan(pGeo, pGeo2, 0.0000001), String.Format("Mercator_1SP reverse transformation outside tolerance, Expected {0}, got {1}", pGeo.ToString(), pGeo2.ToString()));
  80. }
  81. [Test]
  82. public void TestMercator_2SP_Projection()
  83. {
  84. CoordinateSystemFactory cFac = new SharpMap.CoordinateSystems.CoordinateSystemFactory();
  86. IEllipsoid ellipsoid = cFac.CreateFlattenedSphere("Krassowski 1940", 6378245.0, 298.3, LinearUnit.Metre);
  88. IHorizontalDatum datum = cFac.CreateHorizontalDatum("Krassowski 1940", DatumType.HD_Geocentric, ellipsoid, null);
  89. IGeographicCoordinateSystem gcs = cFac.CreateGeographicCoordinateSystem("Krassowski 1940", AngularUnit.Degrees, datum,
  90. PrimeMeridian.Greenwich, new AxisInfo("Lon", AxisOrientationEnum.East),
  91. new AxisInfo("Lat", AxisOrientationEnum.North));
  92.             //System.Collections.ObjectModel.Collection<ProjectionParameter> parameters = new System.Collections.ObjectModel.Collection<ProjectionParameter>(5);
  93.             System.Collections.ObjectModel.Collection<ProjectionParameter> parameters = new System.Collections.ObjectModel.Collection<ProjectionParameter>();
  94. parameters.Add(new ProjectionParameter("latitude_of_origin", 42));
  95. parameters.Add(new ProjectionParameter("central_meridian", 51));
  96. parameters.Add(new ProjectionParameter("false_easting", 0));
  97. parameters.Add(new ProjectionParameter("false_northing", 0));
  98. IProjection projection = cFac.CreateProjection("Mercator_2SP", "Mercator_2SP", parameters);
  100. IProjectedCoordinateSystem coordsys = cFac.CreateProjectedCoordinateSystem("Pulkovo 1942 / Mercator Caspian Sea", gcs, projection, LinearUnit.Metre, new AxisInfo("East", AxisOrientationEnum.East), new AxisInfo("North", AxisOrientationEnum.North));
  102. ICoordinateTransformation trans = new CoordinateTransformationFactory().CreateFromCoordinateSystems(gcs, coordsys);
  104. SharpMap.Geometries.Point pGeo = new SharpMap.Geometries.Point(53, 53);
  105. SharpMap.Geometries.Point pUtm = trans.MathTransform.Transform(pGeo);
  106. SharpMap.Geometries.Point pGeo2 = trans.MathTransform.Inverse().Transform(pUtm);
  108. SharpMap.Geometries.Point expected = new Point(165704.29, 5171848.07);
  109. Assert.IsTrue(ToleranceLessThan(pUtm, expected, 0.02), String.Format("Mercator_2SP forward transformation outside tolerance, Expected {0}, got {1}", expected.ToString(), pUtm.ToString()));
  110. Assert.IsTrue(ToleranceLessThan(pGeo, pGeo2, 0.0000001), String.Format("Mercator_2SP reverse transformation outside tolerance, Expected {0}, got {1}", pGeo.ToString(), pGeo2.ToString()));
  111. }
  112. [Test]
  113. public void TestTransverseMercator_Projection()
  114. {
  115. CoordinateSystemFactory cFac = new SharpMap.CoordinateSystems.CoordinateSystemFactory();
  117. IEllipsoid ellipsoid = cFac.CreateFlattenedSphere("Airy 1830", 6377563.396, 299.32496, LinearUnit.Metre);
  119. IHorizontalDatum datum = cFac.CreateHorizontalDatum("Airy 1830", DatumType.HD_Geocentric, ellipsoid, null);
  120. IGeographicCoordinateSystem gcs = cFac.CreateGeographicCoordinateSystem("Airy 1830", AngularUnit.Degrees, datum,
  121. PrimeMeridian.Greenwich, new AxisInfo("Lon", AxisOrientationEnum.East),
  122. new AxisInfo("Lat", AxisOrientationEnum.North));
  123.             //System.Collections.ObjectModel.Collection<ProjectionParameter> parameters = new System.Collections.ObjectModel.Collection<ProjectionParameter>(5);
  124.             System.Collections.ObjectModel.Collection<ProjectionParameter> parameters = new System.Collections.ObjectModel.Collection<ProjectionParameter>();
  125. parameters.Add(new ProjectionParameter("latitude_of_origin", 49));
  126. parameters.Add(new ProjectionParameter("central_meridian", -2));
  127. parameters.Add(new ProjectionParameter("scale_factor", 0.9996012717));
  128. parameters.Add(new ProjectionParameter("false_easting", 400000));
  129. parameters.Add(new ProjectionParameter("false_northing", -100000));
  130. IProjection projection = cFac.CreateProjection("Transverse Mercator", "Transverse_Mercator", parameters);
  132. IProjectedCoordinateSystem coordsys = cFac.CreateProjectedCoordinateSystem("OSGB 1936 / British National Grid", gcs, projection, LinearUnit.Metre, new AxisInfo("East", AxisOrientationEnum.East), new AxisInfo("North", AxisOrientationEnum.North));
  134. ICoordinateTransformation trans = new CoordinateTransformationFactory().CreateFromCoordinateSystems(gcs, coordsys);
  136. SharpMap.Geometries.Point pGeo = new SharpMap.Geometries.Point(0.5, 50.5);
  137. SharpMap.Geometries.Point pUtm = trans.MathTransform.Transform(pGeo);
  138. SharpMap.Geometries.Point pGeo2 = trans.MathTransform.Inverse().Transform(pUtm);
  140. SharpMap.Geometries.Point expected = new Point(577274.99, 69740.50);
  141. Assert.IsTrue(ToleranceLessThan(pUtm, expected, 0.02), String.Format("TransverseMercator forward transformation outside tolerance, Expected {0}, got {1}", expected.ToString(), pUtm.ToString()));
  142. Assert.IsTrue(ToleranceLessThan(pGeo, pGeo2, 0.0000001), String.Format("TransverseMercator reverse transformation outside tolerance, Expected {0}, got {1}", pGeo.ToString(), pGeo2.ToString()));
  143. }
  144. [Test]
  145. public void TestLambertConicConformal2SP_Projection()
  146. {
  147. CoordinateSystemFactory cFac = new SharpMap.CoordinateSystems.CoordinateSystemFactory();
  149. IEllipsoid ellipsoid = cFac.CreateFlattenedSphere("Clarke 1866", 20925832.16, 294.97470, LinearUnit.USSurveyFoot);
  151. IHorizontalDatum datum = cFac.CreateHorizontalDatum("Clarke 1866", DatumType.HD_Geocentric, ellipsoid, null);
  152. IGeographicCoordinateSystem gcs = cFac.CreateGeographicCoordinateSystem("Clarke 1866", AngularUnit.Degrees, datum,
  153. PrimeMeridian.Greenwich, new AxisInfo("Lon", AxisOrientationEnum.East),
  154. new AxisInfo("Lat", AxisOrientationEnum.North));
  155.             //System.Collections.ObjectModel.Collection<ProjectionParameter> parameters = new System.Collections.ObjectModel.Collection<ProjectionParameter>(5);
  156.             System.Collections.ObjectModel.Collection<ProjectionParameter> parameters = new System.Collections.ObjectModel.Collection<ProjectionParameter>();
  157. parameters.Add(new ProjectionParameter("latitude_of_origin", 27.833333333));
  158. parameters.Add(new ProjectionParameter("central_meridian", -99));
  159. parameters.Add(new ProjectionParameter("standard_parallel_1", 28.3833333333));
  160. parameters.Add(new ProjectionParameter("standard_parallel_2", 30.2833333333));
  161. parameters.Add(new ProjectionParameter("false_easting", 2000000));
  162. parameters.Add(new ProjectionParameter("false_northing", 0));
  163. IProjection projection = cFac.CreateProjection("Lambert Conic Conformal (2SP)", "lambert_conformal_conic_2sp", parameters);
  165. IProjectedCoordinateSystem coordsys = cFac.CreateProjectedCoordinateSystem("NAD27 / Texas South Central", gcs, projection, LinearUnit.USSurveyFoot, new AxisInfo("East", AxisOrientationEnum.East), new AxisInfo("North", AxisOrientationEnum.North));
  167. ICoordinateTransformation trans = new CoordinateTransformationFactory().CreateFromCoordinateSystems(gcs, coordsys);
  169. SharpMap.Geometries.Point pGeo = new SharpMap.Geometries.Point(-96, 28.5);
  170. SharpMap.Geometries.Point pUtm = trans.MathTransform.Transform(pGeo);
  171. SharpMap.Geometries.Point pGeo2 = trans.MathTransform.Inverse().Transform(pUtm);
  173. SharpMap.Geometries.Point expected = new Point(2963503.91, 254759.80);
  174. Assert.IsTrue(ToleranceLessThan(pUtm, expected, 0.02), String.Format("LambertConicConformal2SP forward transformation outside tolerance, Expected {0}, got {1}", expected.ToString(), pUtm.ToString()));
  175. Assert.IsTrue(ToleranceLessThan(pGeo, pGeo2, 0.0000001), String.Format("LambertConicConformal2SP reverse transformation outside tolerance, Expected {0}, got {1}", pGeo.ToString(), pGeo2.ToString()));
  177. }
  179. [Test]
  180. public void TestGeocentric()
  181. {
  182. CoordinateSystemFactory cFac = new CoordinateSystemFactory();
  183. IGeographicCoordinateSystem gcs = cFac.CreateGeographicCoordinateSystem("ETRF89 Geographic", AngularUnit.Degrees, HorizontalDatum.ETRF89, PrimeMeridian.Greenwich,
  184. new AxisInfo("East", AxisOrientationEnum.East), new AxisInfo("North", AxisOrientationEnum.North));
  185. IGeocentricCoordinateSystem gcenCs = cFac.CreateGeocentricCoordinateSystem("ETRF89 Geocentric", HorizontalDatum.ETRF89, LinearUnit.Metre, PrimeMeridian.Greenwich);
  186. CoordinateTransformationFactory gtFac = new CoordinateTransformationFactory();
  187. ICoordinateTransformation ct = gtFac.CreateFromCoordinateSystems(gcs,gcenCs);
  188. Point pExpected = Point.FromDMS(2, 7, 46.38, 53, 48, 33.82);
  189. Point3D pExpected3D = new Point3D(pExpected.X, pExpected.Y, 73.0);
  190. Point3D p0 = new Point3D(3771793.97, 140253.34, 5124304.35);
  191. Point3D p1 = ct.MathTransform.Transform(pExpected3D) as Point3D;
  192. Point3D p2 = ct.MathTransform.Inverse().Transform(p1) as Point3D;
  193. Assert.IsTrue(ToleranceLessThan(p1, p0, 0.01));
  194. Assert.IsTrue(ToleranceLessThan(p2, pExpected, 0.00001));
  195. }
  197. [Test]
  198. public void TestDatumTransform()
  199. {
  200. CoordinateSystemFactory cFac = new CoordinateSystemFactory();
  201. //Define datums
  202. HorizontalDatum wgs72 = HorizontalDatum.WGS72;
  203. HorizontalDatum ed50 = HorizontalDatum.ED50;
  205. //Define geographic coordinate systems
  206. IGeographicCoordinateSystem gcsWGS72 = cFac.CreateGeographicCoordinateSystem("WGS72 Geographic", AngularUnit.Degrees, wgs72, PrimeMeridian.Greenwich,
  207. new AxisInfo("East", AxisOrientationEnum.East), new AxisInfo("North", AxisOrientationEnum.North));
  209. IGeographicCoordinateSystem gcsWGS84 = cFac.CreateGeographicCoordinateSystem("WGS84 Geographic", AngularUnit.Degrees, HorizontalDatum.WGS84, PrimeMeridian.Greenwich,
  210. new AxisInfo("East", AxisOrientationEnum.East), new AxisInfo("North", AxisOrientationEnum.North));
  212. IGeographicCoordinateSystem gcsED50 = cFac.CreateGeographicCoordinateSystem("ED50 Geographic", AngularUnit.Degrees, ed50, PrimeMeridian.Greenwich,
  213. new AxisInfo("East", AxisOrientationEnum.East), new AxisInfo("North", AxisOrientationEnum.North));
  215. //Define geocentric coordinate systems
  216. IGeocentricCoordinateSystem gcenCsWGS72 = cFac.CreateGeocentricCoordinateSystem("WGS72 Geocentric", wgs72, LinearUnit.Metre, PrimeMeridian.Greenwich);
  217. IGeocentricCoordinateSystem gcenCsWGS84 = cFac.CreateGeocentricCoordinateSystem("WGS84 Geocentric", HorizontalDatum.WGS84, LinearUnit.Metre, PrimeMeridian.Greenwich);
  218. IGeocentricCoordinateSystem gcenCsED50 = cFac.CreateGeocentricCoordinateSystem("ED50 Geocentric", ed50, LinearUnit.Metre, PrimeMeridian.Greenwich);
  220. //Define projections
  221.             //System.Collections.ObjectModel.Collection<ProjectionParameter> parameters = new System.Collections.ObjectModel.Collection<ProjectionParameter>(5);
  222.             System.Collections.ObjectModel.Collection<ProjectionParameter> parameters = new System.Collections.ObjectModel.Collection<ProjectionParameter>();
  223. parameters.Add(new ProjectionParameter("latitude_of_origin", 0));
  224. parameters.Add(new ProjectionParameter("central_meridian", 9));
  225. parameters.Add(new ProjectionParameter("scale_factor", 0.9996));
  226. parameters.Add(new ProjectionParameter("false_easting", 500000));
  227. parameters.Add(new ProjectionParameter("false_northing", 0));
  228. IProjection projection = cFac.CreateProjection("Transverse Mercator", "Transverse_Mercator", parameters);
  229. IProjectedCoordinateSystem utmED50 = cFac.CreateProjectedCoordinateSystem("ED50 UTM Zone 32N", gcsED50, projection, LinearUnit.Metre, new AxisInfo("East", AxisOrientationEnum.East), new AxisInfo("North", AxisOrientationEnum.North));
  230. IProjectedCoordinateSystem utmWGS84 = cFac.CreateProjectedCoordinateSystem("WGS84 UTM Zone 32N", gcsWGS84, projection, LinearUnit.Metre, new AxisInfo("East", AxisOrientationEnum.East), new AxisInfo("North", AxisOrientationEnum.North));
  232. //Set TOWGS84 parameters
  233. wgs72.Wgs84Parameters = new Wgs84ConversionInfo(0, 0, 4.5, 0, 0, 0.554, 0.219);
  234. ed50.Wgs84Parameters = new Wgs84ConversionInfo(-81.0703, -89.3603, -115.7526,
  235.    -0.48488, -0.02436, -0.41321,
  236.    -0.540645); //Parameters for Denmark
  238. //Set up coordinate transformations
  239. CoordinateTransformationFactory ctFac = new CoordinateTransformationFactory();
  240. ICoordinateTransformation ctForw = ctFac.CreateFromCoordinateSystems(gcsWGS72, gcenCsWGS72); //Geographic->Geocentric (WGS72)
  241. ICoordinateTransformation ctWGS84_Gcen2Geo = ctFac.CreateFromCoordinateSystems(gcenCsWGS84, gcsWGS84);  //Geocentric->Geographic (WGS84)
  242. ICoordinateTransformation ctWGS84_Geo2UTM = ctFac.CreateFromCoordinateSystems(gcsWGS84, utmWGS84);  //UTM ->Geographic (WGS84)
  243. ICoordinateTransformation ctED50_UTM2Geo = ctFac.CreateFromCoordinateSystems(utmED50, gcsED50);  //UTM ->Geographic (ED50)
  244. ICoordinateTransformation ctED50_Geo2Gcen = ctFac.CreateFromCoordinateSystems(gcsED50, gcenCsED50); //Geographic->Geocentric (ED50)
  246. //Test datum-shift from WGS72 to WGS84
  247. //Point3D pGeoCenWGS72 = ctForw.MathTransform.Transform(pLongLatWGS72) as Point3D;
  248. Point3D pGeoCenWGS72 = new Point3D(3657660.66, 255768.55, 5201382.11);
  249. ICoordinateTransformation geocen_ed50_2_Wgs84 = ctFac.CreateFromCoordinateSystems(gcenCsWGS72, gcenCsWGS84);
  250. Point3D pGeoCenWGS84 = geocen_ed50_2_Wgs84.MathTransform.Transform(pGeoCenWGS72) as Point3D;
  251. //Point3D pGeoCenWGS84 = wgs72.Wgs84Parameters.Apply(pGeoCenWGS72);
  253. Assert.IsTrue(ToleranceLessThan(new Point3D(3657660.78, 255778.43, 5201387.75), pGeoCenWGS84, 0.01));
  255. ICoordinateTransformation utm_ed50_2_Wgs84 = ctFac.CreateFromCoordinateSystems(utmED50, utmWGS84);
  256. Point pUTMED50 = new Point(600000, 6100000);
  257. Point pUTMWGS84 = utm_ed50_2_Wgs84.MathTransform.Transform(pUTMED50);
  258. Assert.IsTrue(ToleranceLessThan(new Point(599928.6, 6099790.2), pUTMWGS84, 0.1));
  259. //Perform reverse
  260. ICoordinateTransformation utm_Wgs84_2_Ed50 = ctFac.CreateFromCoordinateSystems(utmWGS84, utmED50);
  261. pUTMED50 = utm_Wgs84_2_Ed50.MathTransform.Transform(pUTMWGS84);
  262. Assert.IsTrue(ToleranceLessThan(new Point(600000, 6100000), pUTMED50, 0.1));
  263. //Assert.IsTrue(Math.Abs((pUTMWGS84 as Point3D).Z - 36.35) < 0.5);
  264. //Point pExpected = Point.FromDMS(2, 7, 46.38, 53, 48, 33.82);
  265. //ED50_to_WGS84_Denmark: datum.Wgs84Parameters = new Wgs84ConversionInfo(-89.5, -93.8, 127.6, 0, 0, 4.5, 1.2);
  267. }
  268. private bool ToleranceLessThan(Point p1, Point p2, double tolerance)
  269. {
  270. return Math.Abs(p1.X - p2.X) < tolerance && Math.Abs(p1.Y - p2.Y) < tolerance;
  271. }
  272. private bool ToleranceLessThan(Point3D p1, Point3D p2, double tolerance)
  273. {
  274. return Math.Abs(p1.X - p2.X) < tolerance && Math.Abs(p1.Y - p2.Y) < tolerance && Math.Abs(p1.Z - p2.Z) < tolerance;
  275. }
  276. }
  277. }