Split UseItem module

src/Geometry/Vector.hs

@@ -0,0 +1,141 @@
+{-# LANGUAGE BangPatterns #-}
+module Geometry.Vector
+    where
+import Geometry.Data
+
+zeroZ :: Point2 -> Point3
+{-# INLINE zeroZ #-}
+zeroZ (x,y) = (x,y,0)
+
+infixl 6 +.+, -.-
+infixl 7 *.*
+
+(+.+) :: Point2 -> Point2 -> Point2
+{-# INLINE (+.+) #-}
+(x1, y1) +.+ (x2, y2) =
+  let
+    !x = x1 + x2
+    !y = y1 + y2
+  in (x, y)
+
+(-.-) :: Point2 -> Point2 -> Point2
+{-# INLINE (-.-) #-}
+(x1, y1) -.- (x2, y2) =
+  let
+    !x = x1 - x2
+    !y = y1 - y2
+  in (x, y)
+
+(*.*) :: Float -> Point2 -> Point2
+{-# INLINE (*.*) #-}
+a *.* (x2, y2) =
+  let
+    !x = a * x2
+    !y = a * y2
+  in (x, y)
+
+infixl 6 +.+.+, -.-.-
+infixl 7 *.*.*
+
+(+.+.+) :: Point3 -> Point3 -> Point3
+{-# INLINE (+.+.+) #-}
+(x1, y1, z1) +.+.+ (x2, y2, z2) =
+  let
+    !x = x1 + x2
+    !y = y1 + y2
+    !z = z1 + z2
+  in (x, y, z)
+
+(-.-.-) :: Point3 -> Point3 -> Point3
+{-# INLINE (-.-.-) #-}
+(x1, y1, z1) -.-.- (x2, y2, z2) =
+  let
+    !x = x1 - x2
+    !y = y1 - y2
+    !z = z1 - z2
+  in (x, y, z)
+
+(*.*.*) :: Point3 -> Point3 -> Point3
+{-# INLINE (*.*.*) #-}
+(x1, y1, z1) *.*.* (x2, y2, z2) =
+  let
+    !x = x1 * x2
+    !y = y1 * y2
+    !z = z1 * z2
+  in (x, y, z)
+
+normalizeV :: Point2 -> Point2
+{-# INLINE normalizeV #-}
+normalizeV p = (1 / magV p) *.* p
+
+angleVV :: Point2 -> Point2 -> Float
+{-# INLINE angleVV #-}
+angleVV a b = let ma = magV a
+                  mb = magV b
+                  d  = a `dotV` b
+              in  acos $ d / (ma * mb)
+
+dotV :: Point2 -> Point2 -> Float
+{-# INLINE dotV #-}
+dotV (x,y) (z,w) = x*z + y*w
+
+argV :: Point2 -> Float
+{-# INLINE argV #-}
+argV (x,y) = normalizeAngle $ atan2 y x
+
+detV :: Point2 -> Point2 -> Float
+{-# INLINE detV #-}
+detV (x1, y1) (x2, y2)
+       = x1 * y2 - y1 * x2
+
+-- | Angle in radians, anticlockwise from +ve x-axis.
+unitVectorAtAngle :: Float -> Point2
+{-# INLINE unitVectorAtAngle #-}
+unitVectorAtAngle r
+        = (cos r, sin r)
+
+-- | Rotate a vector by an angle (in radians). +ve angle is counter-clockwise.
+rotateV :: Float -> Point2 -> Point2
+rotateV r (x, y)
+ =      (  x * cos r - y * sin r
+        ,  x * sin r + y * cos r)
+{-# INLINE rotateV #-}
+
+-- | Convert degrees to radians
+degToRad :: Float -> Float
+degToRad d      = d * pi / 180
+{-# INLINE degToRad #-}
+
+
+-- | Convert radians to degrees
+radToDeg :: Float -> Float
+radToDeg r      = r * 180 / pi
+{-# INLINE radToDeg #-}
+
+
+-- | Normalize an angle to be between 0 and 2*pi radians
+normalizeAngle :: Float -> Float
+normalizeAngle f = f - 2 * pi * floor' (f / (2 * pi))
+ where  floor' :: Float -> Float
+        floor' x = fromIntegral (floor x :: Int)
+{-# INLINE normalizeAngle #-}
+
+vNormal :: Point2 -> Point2
+{-# INLINE vNormal #-}
+vNormal (x,y) = (y,-x)
+
+vInverse :: Point2 -> Point2
+vInverse (x,y) = (-x,-y)
+
+normV :: Point2 -> Point2
+{-# INLINE normV #-}
+normV (0,0) = (0,0)
+normV p = (1/magV p ) *.* p
+
+magV :: Point2 -> Float
+{-# INLINE magV #-}
+magV (x,y) = sqrt $ x^2 + y^2
+
+crossV :: Point2 -> Point2 -> Float
+crossV (ax,ay) (bx,by) = ax*by - ay*bx
+