Add CircularBuffer

core/src/main/kotlin/org/ghrobotics/lib/utils/CircularBuffer.kt

@@ -0,0 +1,37 @@
+/*
+ * Copyright (c) 2018 FRC Team 5190
+ * Ryan Segerstrom, Prateek Machiraju
+ */
+
+package org.ghrobotics.lib.utils
+
+import java.util.*
+
+class CircularBuffer(private val size: Int) {
+
+    private val buffer: ArrayList<Double> = ArrayList(size)
+
+    private var numElements = 0
+    private var sum = 0.0
+
+    // Gets average of all elements
+    val average: Double
+        get() {
+            return if (numElements == 0)
+                0.0
+            else
+                sum / numElements
+        }
+
+    // Adds an element to the list
+    fun add(element: Double) {
+        if (numElements > size - 1) {
+            sum -= buffer[size - 1]
+            buffer.removeAt(size - 1)
+            numElements--
+        }
+        sum += element
+        buffer.add(0, element)
+        numElements++
+    }
+}