SCANutil.cs

#region license
/* 
 * [Scientific Committee on Advanced Navigation]
 * 			S.C.A.N. Satellite
 * 
 * SCANutil - various static utilities methods used througout SCANsat
 * 
 * Several extension methods borrowed from Mechjeb:
 * https://github.com/MuMech/MechJeb2/blob/master/MechJeb2/OrbitExtensions.cs
 * 
 * Copyright (c)2014 technogeeky <technogeeky@gmail.com>;
 * Copyright (c)2014 David Grandy <david.grandy@gmail.com>;
 * Copyright (c)2014 (Your Name Here) <your email here>; see LICENSE.txt for licensing details.
 */
#endregion

using System;
using System.Collections.Generic;
using UnityEngine;
using System.Linq;
using KSP.Localization;
using SCANsat.SCAN_PartModules;
using SCANsat.SCAN_Platform;
using SCANsat.SCAN_Platform.Palettes;
using SCANsat.SCAN_Platform.Palettes.ColorBrewer;
using SCANsat.SCAN_Platform.Palettes.FixedColors;
using SCANsat.SCAN_Data;
using SCANsat.SCAN_UI.UI_Framework;
using palette = SCANsat.SCAN_UI.UI_Framework.SCANpalette;

namespace SCANsat
{

	public static class SCANUtil
	{

		#region Public API Methods

		/// <summary>
		/// Determines scanning coverage for a given area with a given scanner type
		/// </summary>
		/// <param name="lon">Clamped double in the -180 - 180 degree range</param>
		/// <param name="lat">Clamped double in the -90 - 90 degree range</param>
		/// <param name="body">Celestial body in question</param>
		/// <param name="SCANtype">SCANtype cast as an integer</param>
		/// <returns></returns>
		public static bool isCovered(double lon, double lat, CelestialBody body, int SCANtype)
		{
			int ilon = icLON(lon);
			int ilat = icLAT(lat);
			if (badLonLat (ilon, ilat)) return false;

			SCANdata data = getData(body.bodyName);

			if (data == null)
				return false;

			return (data.Coverage[ilon, ilat] & SCANtype) != 0;
		}

		/// <summary>
		/// Determines scanning coverage for a given area with a given scanner type
		/// </summary>
		/// <param name="lon">Clamped integer in the 0-360 degree range</param>
		/// <param name="lat">Clamped integer in the 0-180 degree range</param>
		/// <param name="body">Celestial body in question</param>
		/// <param name="SCANtype">SCANtype cast as an integer</param>
		/// <returns></returns>
		public static bool isCovered(int lon, int lat, CelestialBody body, int SCANtype)
		{
			if (badLonLat(lon, lat)) return false;

			SCANdata data = getData(body.bodyName);

			if (data == null)
				return false;

			return (data.Coverage[lon, lat] & SCANtype) != 0;
		}

		/// <summary>
		/// Public method to return the scanning coverage for a given sensor type on a give body
		/// </summary>
		/// <param name="SCANtype">Integer corresponding to the desired SCANtype</param>
		/// <param name="Body">Desired Celestial Body</param>
		/// <returns>Scanning percentage as a double from 0-100</returns>
		public static double GetCoverage(int SCANtype, CelestialBody Body)
		{
			SCANdata data = getData(Body.bodyName);

			if (data == null)
				return 0;

			return getCoveragePercentage(data, (SCANtype)SCANtype);
		}

		/// <summary>
		/// Given the name of the SCANtype, returns the int value.
		/// </summary>
		/// <param name="SCANname">The name of the SCANtype.</param>
		/// <returns>The int value that can be used in other public methods.</returns>
		public static int GetSCANtype(string SCANname)
		{
			try
			{
				return (int)Enum.Parse(typeof(SCANtype), SCANname);
			}
			catch (ArgumentException e)
			{
				throw new ArgumentException("An invalid SCANtype name was provided.  Valid values are: " +
					string.Join(", ", ((IEnumerable<SCANtype>)Enum.GetValues(typeof(SCANtype))).Select<SCANtype, string>(x => x.ToString()).ToArray()) + "\n" + e.ToString());
			}
		}

		/// <summary>
		/// For a given Celestial Body this returns the SCANdata instance if it exists in the SCANcontroller master dictionary; return is null if the SCANdata does not exist for that body (ie it has never been visited while SCANsat has been active)
		/// </summary>
		/// <param name="body">Celestial Body object</param>
		/// <returns>SCANdata instance for the given Celestial Body; null if none exists</returns>
		public static SCANdata getData(CelestialBody body)
		{
			return getData(body.bodyName);
		}

		/// <summary>
		/// For a given Celestial Body name this returns the SCANdata instance if it exists in the SCANcontroller master dictionary; return is null if the SCANdata does not exist for that body (ie it has never been visited while SCANsat has been active), or if the SCANcontroller Scenario Module has not been loaded.
		/// </summary>
		/// <param name="BodyName">Name of celestial body (do not use displayName string)</param>
		/// <returns>SCANdata instance for the given Celestial Body; null if none exists</returns>
		public static SCANdata getData(string BodyName)
		{
			if (SCANcontroller.controller == null)
				return null;

			return SCANcontroller.controller.getData(BodyName);
		}

		/// <summary>
		/// Do SCANsat maps automatically update with the stock, instant-scan orbital surveys?
		/// </summary>
		/// <returns>Returns true if instant scan is enabled</returns>
		public static bool instantResourceScanEnabled()
		{
			if (SCAN_Settings_Config.Instance == null)
				return true;

			return SCAN_Settings_Config.Instance.InstantScan;
		}

		/// <summary>
		/// Are the stock resource scanner functions disabled? prevents orbital resource surveys
		/// </summary>
		/// <returns>Returns true if stock resource scanning is available</returns>
		public static bool stockResourceScanEnabled()
		{
			if (SCAN_Settings_Config.Instance == null)
				return false;

			return !SCAN_Settings_Config.Instance.DisableStockResource;
		}

		/// <summary>
		/// Is the stock resource biome lock enabled? reduced resource abundace accuracy if enabled
		/// </summary>
		/// <returns>Returns true if the biome lock is enabled</returns>
		public static bool resourceBiomeLockEnabled()
		{
			if (SCAN_Settings_Config.Instance == null)
				return true;

			return SCAN_Settings_Config.Instance.BiomeLock;
		}

		/// <summary>
		/// Is a narrow-band scanner required on the current vessel for full resource data?
		/// </summary>
		/// <returns>Returns true if a narrow-band scanner is required</returns>
		public static bool narrowBandResourceRestrictionEnabled()
		{
			if (SCAN_Settings_Config.Instance == null)
				return true;

			return SCAN_Settings_Config.Instance.RequireNarrowBand;
		}

		/// <summary>
		/// Registers a SCANsat sensor externally
		/// </summary>
		/// <param name="v">Scanning vessel</param>
		/// <param name="m">ProtoPartModuleSnapshot, should be of type SCANsat or ModuleSCANresourceScanner</param>
		/// <param name="prefab">Part Prefab, must contain either a SCANsat module or a ModuleSCANresourceScanner</param>
		/// <returns>Returns true if the sensor is successfully registered</returns>
		public static bool registerSensorExternal(Vessel v, ProtoPartModuleSnapshot m, Part prefab)
		{
			if (v == null)
				return false;

			if (m == null)
				return false;

			if (prefab == null)
				return false;

			if (!(m.moduleName == "SCANsat" || m.moduleName == "ModuleSCANresourceScanner"))
				return false;

			int sensor = 0;
			double fov = 0;
			double min = 0;
			double max = 0;
			double best = 0;

			if (prefab.Modules.Contains<SCANsat.SCAN_PartModules.SCANsat>())
			{
				SCANsat.SCAN_PartModules.SCANsat scan = prefab.Modules.GetModule<SCANsat.SCAN_PartModules.SCANsat>();

				if (scan == null)
					return false;

				sensor = scan.sensorType;
				fov = scan.fov;
				min = scan.min_alt;
				max = scan.max_alt;
				best = scan.best_alt;
			}
			else if (prefab.Modules.Contains<ModuleSCANresourceScanner>())
			{
				SCANsat.SCAN_PartModules.ModuleSCANresourceScanner scan = prefab.Modules.GetModule<SCANsat.SCAN_PartModules.ModuleSCANresourceScanner>();

				if (scan == null)
					return false;

				sensor = scan.sensorType;
				fov = scan.fov;
				min = scan.min_alt;
				max = scan.max_alt;
				best = scan.best_alt;
			}
			else
				return false;

			if (SCANcontroller.controller == null)
				return false;

			SCANcontroller.controller.registerSensor(v, (SCANtype)sensor, fov, min, max, best);

			m.moduleValues.SetValue("scanning", true.ToString());

			return true;
		}

		/// <summary>
		/// Unregisters a SCANsat sensor externally
		/// </summary>
		/// <param name="v">Scanning vessel</param>
		/// <param name="m">ProtoPartModuleSnapshot, should be of type SCANsat or ModuleSCANresourceScanner<</param>
		/// <param name="prefab">Part Prefab, must contain either a SCANsat module or a ModuleSCANresourceScanner</param>
		/// <returns>Returns true if the sensor is successfully registered</returns>
		public static bool unregisterSensorExternal(Vessel v, ProtoPartModuleSnapshot m, Part prefab)
		{
			if (v == null)
				return false;

			if (m == null)
				return false;

			if (prefab == null)
				return false;

			if (!(m.moduleName == "SCANsat" || m.moduleName == "ModuleSCANresourceScanner"))
				return false;

			int sensor = 0;

			if (prefab.Modules.Contains<SCANsat.SCAN_PartModules.SCANsat>())
			{
				SCANsat.SCAN_PartModules.SCANsat scan = prefab.Modules.GetModule<SCANsat.SCAN_PartModules.SCANsat>();

				if (scan == null)
					return false;

				sensor = scan.sensorType;
			}
			else if (prefab.Modules.Contains<ModuleSCANresourceScanner>())
			{
				SCANsat.SCAN_PartModules.ModuleSCANresourceScanner scan = prefab.Modules.GetModule<SCANsat.SCAN_PartModules.ModuleSCANresourceScanner>();

				if (scan == null)
					return false;

				sensor = scan.sensorType;
			}
			else
				return false;

			if (SCANcontroller.controller == null)
				return false;

			SCANcontroller.controller.unregisterSensor(v, (SCANtype)sensor);

			m.moduleValues.SetValue("scanning", false.ToString());

			return true;
		}

		#endregion

		#region Internal Utilities

		internal static bool isCovered(double lon, double lat, SCANdata data, SCANtype type)
		{
			int ilon = icLON(lon);
			int ilat = icLAT(lat);
			if (badLonLat(ilon, ilat)) return false;
			return (data.Coverage[ilon, ilat] & (Int32)type) != 0;
		}

		internal static bool isCovered(int lon, int lat, SCANdata data, SCANtype type)
		{
			if (badLonLat(lon, lat)) return false;
			return (data.Coverage[lon, lat] & (Int32)type) != 0;
		}

		internal static bool isCoveredByAll (int lon, int lat, SCANdata data, SCANtype type)
		{
			if (badLonLat(lon,lat)) return false;
			return (data.Coverage[lon, lat] & (Int32)type) == (Int32)type;
		}

		internal static void registerPass ( double lon, double lat, SCANdata data, SCANtype type ) {
			int ilon = icLON(lon);
			int ilat = icLAT(lat);
			if (badLonLat(ilon, ilat)) return;
			data.Coverage[ilon, ilat] |= (Int32)type;
		}

		internal static double getCoveragePercentage(SCANdata data, SCANtype type )
		{
			if (data == null)
				return 0;
			double cov = 0d;
			if (type == SCANtype.Nothing)
				type = SCANtype.AltimetryLoRes | SCANtype.AltimetryHiRes | SCANtype.Biome | SCANtype.Anomaly;          
			cov = data.getCoverage (type);
			if (cov <= 0)
				cov = 100;
			else
				cov = Math.Min (99.9d , 100 - cov * 100d / (360d * 180d * countBits((int)type)));
			return cov;
		}

		internal static Func<double, int> icLON = (lon) => ((int)(lon + 360 + 180)) % 360;
		internal static Func<double, int> icLAT = (lat) => ((int)(lat + 180 + 90)) % 180;
		internal static Func<int, int, bool> badLonLat = (lon, lat) => (lon < 0 || lat < 0 || lon >= 360 || lat >= 180);
		internal static Func<double, double, bool> badDLonLat = (lon, lat) => (lon < 0 || lat <0 || lon >= 360 || lat >= 180);
		public static Func<double, double, bool> ApproxEq = (a, b) => Math.Abs(a - b) < 0.01;

		internal static double fixLatShift(double lat)
		{
			return (lat + 180 + 90) % 180 - 90;
		}

		internal static double fixLat(double lat)
		{
			return (lat + 180 + 90) % 180;
		}

		internal static double fixLonShift(double lon)
		{
			return (lon + 360 + 180) % 360 - 180;
		}

		internal static double fixLon(double lon)
		{
			return (lon + 360 + 180) % 360;
		}

		internal static Vector2d fixRetardCoordinates(Vector2d coords)
		{
			if (coords.y < -90)
			{
				while (coords.y < -90)
					coords.y += 90;
				coords.y = -90 + Math.Abs(coords.y);
				coords.x = fixLonShift(coords.x + 180);

				return coords;
			}

			if (coords.y > 90)
			{
				while (coords.y > 90)
					coords.y -= 90;
				coords.y = 90 - Math.Abs(coords.y);
				coords.x = fixLonShift(coords.x - 180);

				return coords;
			}

			coords.x = fixLonShift(coords.x);

			return coords;
		}

		internal static double getElevation(CelestialBody body, double lon, double lat)
		{
			if (body.pqsController == null) return 0;
			double rlon = Mathf.Deg2Rad * lon;
			double rlat = Mathf.Deg2Rad * lat;
			Vector3d rad = new Vector3d(Math.Cos(rlat) * Math.Cos(rlon), Math.Sin(rlat), Math.Cos(rlat) * Math.Sin(rlon));
			return Math.Round(body.pqsController.GetSurfaceHeight(rad) - body.pqsController.radius, 1);
		}

		internal static double getElevation(CelestialBody body, int lon, int lat)
		{
			if (body.pqsController == null) return 0;
			double rlon = Mathf.Deg2Rad * lon;
			double rlat = Mathf.Deg2Rad * lat;
			Vector3d rad = new Vector3d(Math.Cos(rlat) * Math.Cos(rlon), Math.Sin(rlat), Math.Cos(rlat) * Math.Sin(rlon));
			return Math.Round(body.pqsController.GetSurfaceHeight(rad) - body.pqsController.radius, 1);
		}

		internal static double getElevation(this CelestialBody body, Vector3d worldPosition)
		{
			if (body.pqsController == null)
				return 0;
			Vector3d pqsRadialVector = QuaternionD.AngleAxis(body.GetLongitude(worldPosition), Vector3d.down) * QuaternionD.AngleAxis(body.GetLatitude(worldPosition), Vector3d.forward) * Vector3d.right;
			double ret = body.pqsController.GetSurfaceHeight(pqsRadialVector) - body.pqsController.radius;
			if (ret < 0)
				ret = 0;
			return ret;
		}

		internal static float ResourceOverlay(double lat, double lon, string name, CelestialBody body, bool biomeLock)
		{
			float amount = 0f;
			var aRequest = new AbundanceRequest
			{
				Latitude = lat,
				Longitude = lon,
				BodyId = body.flightGlobalsIndex,
				ResourceName = name,
				ResourceType = HarvestTypes.Planetary,
				Altitude = 0,
				CheckForLock = biomeLock,
				BiomeName = getBiomeName(body, lon, lat),
				ExcludeVariance = false,
			};

			amount = ResourceMap.Instance.GetAbundance(aRequest);
			return amount;
		}

		private static int getBiomeIndex(CelestialBody body, double lon , double lat)
		{
			if (body.BiomeMap == null)		return -1;
			double u = fixLon(lon);
			double v = fixLat(lat);

			if (badDLonLat(u, v))
				return -1;
			CBAttributeMapSO.MapAttribute att = body.BiomeMap.GetAtt (Mathf.Deg2Rad * lat , Mathf.Deg2Rad * lon);
			for (int i = 0; i < body.BiomeMap.Attributes.Length; ++i) {
				if (body.BiomeMap.Attributes [i] == att) {
					return i;
				}
			}
			return -1;
		}

		internal static double getBiomeIndexFraction(CelestialBody body, double lon , double lat)
		{
			if (body.BiomeMap == null) return 0f;
			return getBiomeIndex (body, lon , lat) * 1.0f / body.BiomeMap.Attributes.Length;
		}

		internal static CBAttributeMapSO.MapAttribute getBiome(CelestialBody body, double lon , double lat)
		{
			if (body.BiomeMap == null) return null;
			int i = getBiomeIndex(body, lon , lat);
			if (i == -1)
				return null;
			return body.BiomeMap.Attributes [i];
		}

		internal static CBAttributeMapSO.MapAttribute getBiomeCached(CelestialBody body, double lon, double lat)
		{
			if (body.BiomeMap == null) return null;
			return body.BiomeMap.GetAtt(lat * Mathf.Deg2Rad, lon * Mathf.Deg2Rad);
		}

		internal static string getBiomeName(CelestialBody body, double lon , double lat)
		{
			CBAttributeMapSO.MapAttribute a = getBiome (body, lon , lat);
			if (a == null)
				return "unknown";
			return a.name;
		}

		internal static string getBiomeDisplayName(CelestialBody body, double lon , double lat)
		{
			CBAttributeMapSO.MapAttribute a = getBiome(body, lon, lat);
			if (a == null)
				return "unknown";
			return Localizer.Format(a.displayname);
		}

		internal static int countBits(int i)
		{
			int count;
			for(count=0; i!=0; ++count) i &= (i - 1);
			return count;
		}

		internal static string bodyFromDisplayName(string display)
		{
			for (int i = FlightGlobals.Bodies.Count - 1; i >= 0; i--)
			{
				CelestialBody b = FlightGlobals.Bodies[i];

				if (b.displayName.LocalizeBodyName() == display)
					return b.bodyName;
			}

			return display;
		}

		internal static string displayNameFromBodyName(string body)
		{
			for (int i = FlightGlobals.Bodies.Count - 1; i >= 0; i--)
			{
				CelestialBody b = FlightGlobals.Bodies[i];

				if (b.bodyName == body)
					return b.displayName.LocalizeBodyName();
			}

			return body;
		}

		internal static string resourceFromDisplayName(string display)
		{
			List<SCANresourceGlobal> resources = SCANcontroller.resources();

			for (int i = resources.Count - 1; i >= 0; i--)
			{
				SCANresourceGlobal r = resources[i];

				if (r.DisplayName == display)
					return r.Name;
			}

			return display;
		}

		internal static string displayNameFromResource(string resource)
		{
			List<SCANresourceGlobal> resources = SCANcontroller.resources();

			for (int i = resources.Count - 1; i >= 0; i--)
			{
				SCANresourceGlobal r = resources[i];

				if (r.Name == resource)
					return r.DisplayName;
			}

			return resource;
		}

		internal static Palette paletteLoader(string name, int size)
		{
			if (name == "Default" || string.IsNullOrEmpty(name))
				return PaletteLoader.defaultPalette;
			else
			{
				try
				{
					if (name == "blackForest" || name == "departure" || name == "northRhine" || name == "mars" || name == "wiki2" || name == "plumbago" || name == "cw1_013" || name == "arctic" || name == "mercury" || name == "venus")
					{
						//Load the fixed size color palette by name through reflection
						var fixedPallete = typeof(FixedColorPalettes);
						var fPaletteMethod = fixedPallete.GetMethod(name);
						var fColorP = fPaletteMethod.Invoke(null, null);
						return (Palette)fColorP;
					}
					else
					{
						//Load the ColorBrewer method by name through reflection
						var brewer = typeof(BrewerPalettes);
						var bPaletteMethod = brewer.GetMethod(name);
						var bColorP = bPaletteMethod.Invoke(null, new object[] { size });
						return (Palette)bColorP;
					}
				}
				catch (Exception e)
				{
					SCANUtil.SCANlog("Error Loading Color Palette; Revert To Default: {0}", e);
					return PaletteLoader.defaultPalette;
				}
			}
		}

		internal static CelestialBody getTargetBody(MapObject target)
		{
			switch (target.type)
			{
				case MapObject.ObjectType.CelestialBody:
					return target.celestialBody;
				case MapObject.ObjectType.ManeuverNode:
					return target.maneuverNode.patch.referenceBody;
				case MapObject.ObjectType.Vessel:
					return target.vessel.mainBody;
				default:
					return null;
			}
		}

		internal static void UpdateAllVesselData(Vessel v)
		{
			List<ScienceData> data = new List<ScienceData>();

			var science = v.FindPartModulesImplementing<IScienceDataContainer>();

			for (int i = science.Count - 1; i >= 0; i--)
			{
				IScienceDataContainer container = science[i];

				data.AddRange(container.GetData());
			}

			if (data.Count <= 0)
				return;

			List<ScienceSubject> subjects = ResearchAndDevelopment.GetSubjects();

			List<ScienceSubject> SCANsubjects = new List<ScienceSubject>();

			for (int i = subjects.Count - 1; i >= 0; i--)
			{
				ScienceSubject sub = subjects[i];

				if (sub.id.StartsWith("SCAN"))
					SCANsubjects.Add(sub);
			}

			for (int i = SCANsubjects.Count - 1; i >= 0; i--)
			{
				ScienceSubject sub = SCANsubjects[i];

				float submittedData = (sub.science / sub.subjectValue) * sub.dataScale;

				for (int j = data.Count - 1; j >= 0; j--)
				{
					ScienceData d = data[j];

					if (d.subjectID != sub.id)
						continue;

					SCANlog("Original Data: [{0}] - Amount: {1:N2} : New Subject: {2} - Adjusted Amount: {3:N0}"
						, d.title, d.dataAmount, sub.title, Math.Max(0.0000001f, d.dataAmount - submittedData));

					d.dataAmount = Math.Max(0.0000001f, d.dataAmount - submittedData);
				}
			}
		}

		internal static void UpdateVesselData(Vessel v, ScienceSubject sub)
		{
			List<ScienceData> data = new List<ScienceData>();

			var science = v.FindPartModulesImplementing<IScienceDataContainer>();

			for (int i = science.Count - 1; i >= 0; i--)
			{
				IScienceDataContainer container = science[i];

				data.AddRange(container.GetData());
			}

			if (data.Count <= 0)
				return;

			float submittedData = (sub.science / sub.subjectValue) * sub.dataScale;

			for (int i = data.Count - 1; i >= 0; i--)
			{
				ScienceData d = data[i];

				if (d.subjectID != sub.id)
					continue;

				SCANlog("Original Data: [{0}] - Amount: {1:N2} : New Subject: {2} - Adjusted Amount: {3:N0}"
					, d.title, d.dataAmount, sub.title, Math.Max(0.0000001f, d.dataAmount - submittedData));

				d.dataAmount = Math.Max(0.0000001f, d.dataAmount - submittedData);
			}
		}

		internal static double waypointDistance(double lat1, double lon1, double alt1, double lat2, double lon2, double alt2, CelestialBody body)
		{
			Vector3d pos1 = body.GetWorldSurfacePosition(lat1, lon1, alt1);
			Vector3d pos2 = body.GetWorldSurfacePosition(lat2, lon2, alt2);
			return (float)Vector3d.Distance(pos1, pos2);
		}

		internal static double mapLabelDistance(double lat1, double lon1, double lat2, double lon2, CelestialBody body)
		{
			Vector3d pos1 = body.GetWorldSurfacePosition(lat1, lon1, 1000);
			Vector3d pos2 = body.GetWorldSurfacePosition(lat2, lon2, 1000);
			return (float)Vector3d.Distance(pos1, pos2);
		}

		internal static double slope(double centerElevation, CelestialBody body, double lon, double lat, double offset)
		{
			/* Slope is calculated using a nine point grid centered 5m around the vessel location
						 * The rise between the vessel location's elevation and each point on the grid is calculated, converted to slope in degrees, and averaged;
						 * Note: Averageing is not the most accurate method
						 */

			double latOffset = offset * Math.Cos(Mathf.Deg2Rad * lat);
			double[] e = new double[9];
			double[] s = new double[8];
			e[0] = centerElevation;
			e[1] = SCANUtil.getElevation(body, lon + latOffset, lat);
			e[2] = SCANUtil.getElevation(body, lon - latOffset, lat);
			e[3] = SCANUtil.getElevation(body, lon, lat + offset);
			e[4] = SCANUtil.getElevation(body, lon, lat - offset);
			e[5] = SCANUtil.getElevation(body, lon + latOffset, lat + offset);
			e[6] = SCANUtil.getElevation(body, lon + latOffset, lat - offset);
			e[7] = SCANUtil.getElevation(body, lon - latOffset, lat + offset);
			e[8] = SCANUtil.getElevation(body, lon - latOffset, lat - offset);

			if (body.ocean)
			{
				for (int i = 0; i < 9; i++)
				{
					if (e[i] < 0)
						e[i] = 0;
				}
			}

			return slope(e, 5);
		}

		internal static double slope (double[] elevations, double distance)
		{
			double[] s = new double[8];

			/* Calculate rise for each point on the grid
			 * The distance is 5m for adjacent points and 7.071m for the points on the corners
			 * Rise is converted to slope; i.e. a 5m elevation change over a 5m distance is a rise of 1
			 * Converted to slope using the inverse tangent this gives a slope of 45°
			 * */

			double diagonalDistance = Math.Sqrt(Math.Pow(distance, 2) * 2);

			for (int i = 1; i <= 4; i++)
			{
				s[i - 1] = Math.Atan((Math.Abs(elevations[i] - elevations[0])) / distance) * Mathf.Rad2Deg;
			}
			for (int i = 5; i <= 8; i++)
			{
				s[i - 1] = Math.Atan((Math.Abs(elevations[i] - elevations[0])) / diagonalDistance) * Mathf.Rad2Deg;
			}

			return s.Sum() / 8;
		}

		internal static double slopeShort(double[] elevations, double distance)
		{
			double[] s = new double[4];

			for (int i = 1; i <= 4; i++)
			{
				s[i - 1] = Math.Atan((Math.Abs(elevations[i] - elevations[0])) / distance) * Mathf.Rad2Deg;
			}

			return s.Sum() / 4;
		}

		internal static bool MouseIsOverWindow()
		{
			if (SCANcontroller.controller == null)
				return false;

			Vector2 pos = new Vector2(Input.mousePosition.x, Screen.height - Input.mousePosition.y);

			return false;
		}

		//This one is straight out of MechJeb :) - https://github.com/MuMech/MechJeb2/blob/master/MechJeb2/GuiUtils.cs#L463-L507
		internal static SCANCoordinates GetMouseCoordinates(CelestialBody body)
		{
			Ray mouseRay = PlanetariumCamera.Camera.ScreenPointToRay(Input.mousePosition);
			mouseRay.origin = ScaledSpace.ScaledToLocalSpace(mouseRay.origin);
			Vector3d relOrigin = mouseRay.origin - body.position;
			Vector3d relSurfacePosition;
			double curRadius = body.pqsController == null ? body.Radius : body.pqsController.radiusMax;
			double lastRadius = 0;
			double error = 0;
			int loops = 0;
			float st = Time.time;
			while (loops < 50)
			{
				if (PQS.LineSphereIntersection(relOrigin, mouseRay.direction, curRadius, out relSurfacePosition))
				{
					Vector3d surfacePoint = body.position + relSurfacePosition;
					double alt = body.pqsController == null ? 0 : body.pqsController.GetSurfaceHeight(QuaternionD.AngleAxis(body.GetLongitude(surfacePoint), Vector3d.down) * QuaternionD.AngleAxis(body.GetLatitude(surfacePoint), Vector3d.forward) * Vector3d.right);
					error = Math.Abs(curRadius - alt);
					if (body.pqsController == null || error < (body.pqsController.radiusMax - body.pqsController.radiusMin) / 100)
					{
						return new SCANCoordinates(fixLonShift((body.GetLongitude(surfacePoint))), fixLatShift(body.GetLatitude(surfacePoint)));
					}
					else
					{

						lastRadius = curRadius;
						curRadius = alt;
						loops++;
					}
				}
				else
				{
					if (loops == 0)
					{
						break;
					}
					else
					{ // Went too low, needs to try higher
						curRadius = (lastRadius * 9 + curRadius) / 10;
						loops++;
					}
				}
			}

			return null;
		}

		public class SCANCoordinates
		{
			public double latitude;
			public double longitude;

			public SCANCoordinates(double lon, double lat)
			{
				longitude = lon;
				latitude = lat;
			}

			public string ToDegString()
			{
				return latitude.ToString("F1") + "°, " + longitude.ToString("F1") + "°";
			}

			public string ToDMS()
			{
				return SCANuiUtil.toDMS(latitude, longitude, 0);
			}
		}

		internal static void SCANlog(string log, params object[] stringObjects)
		{
			log = string.Format(log, stringObjects);
			string finalLog = string.Format("[SCANsat] {0}", log);
			Debug.Log(finalLog);
		}

		[System.Diagnostics.Conditional("DEBUG")]
		internal static void SCANdebugLog(string log, params object[] stringObjects)
		{
			SCANlog(log, stringObjects);
		}

		#endregion

	}

		#region JUtil

		public static class JUtil
		{

				private static readonly int ClosestApproachRefinementInterval = 16;

				public static bool OrbitMakesSense(Vessel thatVessel)
				{
						if (thatVessel == null)
								return false;
						if (thatVessel.situation == Vessel.Situations.FLYING ||
								thatVessel.situation == Vessel.Situations.SUB_ORBITAL ||
								thatVessel.situation == Vessel.Situations.ORBITING ||
								thatVessel.situation == Vessel.Situations.ESCAPING ||
								thatVessel.situation == Vessel.Situations.DOCKED) // Not sure about this last one.
								return true;
						return false;
				}
				// Closest Approach algorithms based on Protractor mod
				public static double GetClosestApproach(Orbit vesselOrbit, CelestialBody targetCelestial, out double timeAtClosestApproach)
				{
						Orbit closestorbit = GetClosestOrbit(vesselOrbit, targetCelestial);
						if (closestorbit.referenceBody == targetCelestial) {
								timeAtClosestApproach = closestorbit.StartUT + ((closestorbit.eccentricity < 1.0) ?
										closestorbit.timeToPe :
										-closestorbit.meanAnomaly / (2 * Math.PI / closestorbit.period));
								return closestorbit.PeA;
						}
						if (closestorbit.referenceBody == targetCelestial.referenceBody) {
								return MinTargetDistance(closestorbit, targetCelestial.orbit, closestorbit.StartUT, closestorbit.EndUT, out timeAtClosestApproach) - targetCelestial.Radius;
						}
						return MinTargetDistance(closestorbit, targetCelestial.orbit, Planetarium.GetUniversalTime(), Planetarium.GetUniversalTime() + closestorbit.period, out timeAtClosestApproach) - targetCelestial.Radius;
				}
				public static double GetClosestApproach(Orbit vesselOrbit, CelestialBody targetCelestial, Vector3d srfTarget, out double timeAtClosestApproach)
				{
						Orbit closestorbit = GetClosestOrbit(vesselOrbit, targetCelestial);
						if (closestorbit.referenceBody == targetCelestial) {
								double t0 = Planetarium.GetUniversalTime();
								Func<double,Vector3d> fn = delegate(double t) {
										double angle = targetCelestial.rotates ? (t - t0) * 360.0 / targetCelestial.rotationPeriod : 0;
										return targetCelestial.position + QuaternionD.AngleAxis(angle, Vector3d.down) * srfTarget;
								};
								double d = MinTargetDistance(closestorbit, fn, closestorbit.StartUT, closestorbit.EndUT, out timeAtClosestApproach);
								// When just passed over the target, some look ahead may be needed
								if ((timeAtClosestApproach <= closestorbit.StartUT || timeAtClosestApproach >= closestorbit.EndUT) &&
										closestorbit.eccentricity < 1 && closestorbit.patchEndTransition == Orbit.PatchTransitionType.FINAL) {
										d = MinTargetDistance(closestorbit, fn, closestorbit.EndUT, closestorbit.EndUT + closestorbit.period / 2, out timeAtClosestApproach);
								}
								return d;
						}
						return GetClosestApproach(vesselOrbit, targetCelestial, out timeAtClosestApproach);
				}

				public static double GetClosestApproach(Orbit vesselOrbit, Orbit targetOrbit, out double timeAtClosestApproach)
				{
						Orbit closestorbit = GetClosestOrbit(vesselOrbit, targetOrbit);

						double startTime = Planetarium.GetUniversalTime();
						double endTime;
						if (closestorbit.patchEndTransition != Orbit.PatchTransitionType.FINAL) {
								endTime = closestorbit.EndUT;
						} else {
								endTime = startTime + Math.Max(closestorbit.period, targetOrbit.period);
						}

						return MinTargetDistance(closestorbit, targetOrbit, startTime, endTime, out timeAtClosestApproach);
				}

				// Closest Approach support methods
				private static Orbit GetClosestOrbit(Orbit vesselOrbit, CelestialBody targetCelestial)
				{
						Orbit checkorbit = vesselOrbit;
						int orbitcount = 0;

						while (checkorbit.nextPatch != null && checkorbit.patchEndTransition != Orbit.PatchTransitionType.FINAL && orbitcount < 3) {
								checkorbit = checkorbit.nextPatch;
								orbitcount += 1;
								if (checkorbit.referenceBody == targetCelestial) {
										return checkorbit;
								}

						}
						checkorbit = vesselOrbit;
						orbitcount = 0;

						while (checkorbit.nextPatch != null && checkorbit.patchEndTransition != Orbit.PatchTransitionType.FINAL && orbitcount < 3) {
								checkorbit = checkorbit.nextPatch;
								orbitcount += 1;
								if (checkorbit.referenceBody == targetCelestial.orbit.referenceBody) {
										return checkorbit;
								}
						}

						return vesselOrbit;
				}

				private static Orbit GetClosestOrbit(Orbit vesselOrbit, Orbit targetOrbit)
				{
						Orbit checkorbit = vesselOrbit;
						int orbitcount = 0;

						while (checkorbit.nextPatch != null && checkorbit.patchEndTransition != Orbit.PatchTransitionType.FINAL && orbitcount < 3) {
								checkorbit = checkorbit.nextPatch;
								orbitcount += 1;
								if (checkorbit.referenceBody == targetOrbit.referenceBody) {
										return checkorbit;
								}

						}

						return vesselOrbit;
				}

				private static double MinTargetDistance(Orbit vesselOrbit, Orbit targetOrbit, double startTime, double endTime, out double timeAtClosestApproach)
				{
						return MinTargetDistance(vesselOrbit, t => targetOrbit.getPositionAtUT(t), startTime, endTime, out timeAtClosestApproach);
				}

				private static double MinTargetDistance(Orbit vesselOrbit, Func<double,Vector3d> targetOrbit, double startTime, double endTime, out double timeAtClosestApproach)
				{
						var dist_at_int = new double[ClosestApproachRefinementInterval + 1];
						double step = startTime;
						double dt = (endTime - startTime) / (double)ClosestApproachRefinementInterval;
						for (int i = 0; i <= ClosestApproachRefinementInterval; i++) {
								dist_at_int[i] = (targetOrbit(step) - vesselOrbit.getPositionAtUT(step)).magnitude;
								step += dt;
						}
						double mindist = dist_at_int.Min();
						double maxdist = dist_at_int.Max();
						int minindex = Array.IndexOf(dist_at_int, mindist);
						if ((maxdist - mindist) / maxdist >= 0.00001) {
								// Don't allow negative times.  Clamp the startTime to the current startTime.
								mindist = MinTargetDistance(vesselOrbit, targetOrbit, startTime + (Math.Max(minindex - 1, 0) * dt), startTime + ((minindex + 1) * dt), out timeAtClosestApproach);
						} else {
								timeAtClosestApproach = startTime + minindex * dt;
						}

						return mindist;
				}
				// Some snippets from MechJeb...
				public static double ClampDegrees360(double angle)
				{
						angle = angle % 360.0;
						if (angle < 0)
								return angle + 360.0;
						return angle;
				}
				//keeps angles in the range -180 to 180
				public static double ClampDegrees180(double angle)
				{
						angle = ClampDegrees360(angle);
						if (angle > 180)
								angle -= 360;
						return angle;
				}
				//acosh(x) = log(x + sqrt(x^2 - 1))
				public static double Acosh(double x)
				{
						return Math.Log(x + Math.Sqrt(x * x - 1));
				}
				public static double ClampRadiansTwoPi(double angle)
				{
						angle = angle % (2 * Math.PI);
						if (angle < 0)
								return angle + 2 * Math.PI;
						return angle;
				}

				public static Material LineMat;

				public static Material DrawLineMaterial()
				{
					if (LineMat == null)
					{
						//var lineMaterial = new Material("Shader \"Lines/Colored Blended\" {" +
						//		"SubShader { Pass {" +
						//		"   BindChannels {" + 
						//		"     Bind \"color\", color }" +
						//		"   Blend SrcAlpha OneMinusSrcAlpha" +
						//		"   ZWrite Off Cull Off Fog { Mode Off }" +
						//		"} } }");
						var lineMaterial = new Material(Shader.Find("Particles/Alpha Blended"));
						lineMaterial.hideFlags = HideFlags.HideAndDontSave;
						lineMaterial.shader.hideFlags = HideFlags.HideAndDontSave;

						LineMat = lineMaterial;
					}

					return LineMat;
				}

				public static bool IsActiveVessel(Vessel thatVessel)
				{
						return (HighLogic.LoadedSceneIsFlight && thatVessel != null	&& thatVessel.isActiveVessel);
				}
				public static bool IsInIVA()
				{
						return CameraManager.Instance.currentCameraMode == CameraManager.CameraMode.IVA || CameraManager.Instance.currentCameraMode == CameraManager.CameraMode.Internal;
				}
		}
	}
		#endregion