Fix TargetTracker bug (#109)

FRC5190 · Jan 23, 2020 · b7946d8 · b7946d8
1 parent a86d7f8
commit b7946d8
Showing 1 changed file with 5 additions and 0 deletions.
diff --git a/wpi/src/main/kotlin/org/ghrobotics/lib/vision/TargetTracker.kt b/wpi/src/main/kotlin/org/ghrobotics/lib/vision/TargetTracker.kt
@@ -130,6 +130,11 @@ open class TargetTracker(private val constants: TargetTrackerConstants) {
         var isReal = true
             private set
 
+        // Add the initial sample to the list of samples.
+        init {
+            addSample(initialSample)
+        }
+
         fun resetFilters() {
             xFilter.reset()
             yFilter.reset()