sin/cos optimizations, cleanup, and optimizations

src/util.rs

@@ -1,4 +1,4 @@
 #[inline(always)]
 pub fn wrap(x: f32, max: f32) -> f32 {
-    x - max * ((x > max) as i32 as f32 - (x < 0.0_f32) as i32 as f32)
-}
+    return x - max * ((x > max) as i32 as f32 - (x < 0.0_f32) as i32 as f32);
+}