]> gitweb.fperrin.net Git - GpsPrune.git/blobdiff - src/tim/prune/function/estimate/jama/Maths.java
Moved source into separate src directory due to popular request
[GpsPrune.git] / src / tim / prune / function / estimate / jama / Maths.java
diff --git a/src/tim/prune/function/estimate/jama/Maths.java b/src/tim/prune/function/estimate/jama/Maths.java
new file mode 100644 (file)
index 0000000..7c3326d
--- /dev/null
@@ -0,0 +1,31 @@
+package tim.prune.function.estimate.jama;
+
+/**
+ * Static helper method, taken from public domain NIST code for JAMA
+ */
+public abstract class Maths
+{
+       /**
+        * Work out sqrt(a^2 + b^2)
+        */
+       public static double pythag(double a, double b)
+       {
+               double r;
+
+               if (Math.abs(a) > Math.abs(b))
+               {
+                       r = b/a;
+                       r = Math.abs(a)*Math.sqrt(1+r*r);
+               }
+               else if (b != 0)
+               {
+                       r = a/b;
+                       r = Math.abs(b)*Math.sqrt(1+r*r);
+               }
+               else
+               {
+                       r = 0.0;
+               }
+               return r;
+       }
+}