1 files changed, 111 insertions, 0 deletions
diff --git a/src/utils/avg_jitterfilter.py b/src/utils/avg_jitterfilter.py
new file mode 100755
index 0000000..6b0f2cb
--- /dev/null
+++ b/src/utils/avg_jitterfilter.py
@@ -0,0 +1,111 @@
+#!/usr/bin/env python
+# -*- coding: utf-8 -*-
+
+# libavg - Media Playback Engine.
+# Copyright (C) 2003-2014 Ulrich von Zadow
+#
+# This library is free software; you can redistribute it and/or
+# modify it under the terms of the GNU Lesser General Public
+# License as published by the Free Software Foundation; either
+# version 2 of the License, or (at your option) any later version.
+#
+# This library is distributed in the hope that it will be useful,
+# but WITHOUT ANY WARRANTY; without even the implied warranty of
+# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+# Lesser General Public License for more details.
+#
+# You should have received a copy of the GNU Lesser General Public
+# License along with this library; if not, write to the Free Software
+# Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+#
+# Current versions can be found at www.libavg.de
+
+from libavg import avg, app, player, filter, widget
+
+
+class LabledSlider(avg.DivNode):
+    def __init__(self, label, range, formatStr, parent=None, **kwargs):
+        super(LabledSlider, self).__init__(**kwargs)
+        self.registerInstance(self, parent)
+        self.__formatStr = formatStr
+
+        fontStyle = widget.Skin.default.fonts["stdFont"]
+        avg.WordsNode(text=label, fontstyle=fontStyle, color="FFFFFF", parent=self)
+        self.__slider = widget.Slider(width=300, range=range, pos=(15,20), parent=self)
+        self.__slider.subscribe(self.__slider.THUMB_POS_CHANGED, self.__onSliderMove)
+        self.__valueDisplay = avg.WordsNode(pos=(320, 18), fontstyle=fontStyle,
+                color="FFFFFF", parent=self)
+        self.__valueDisplay.text = self.__formatStr%self.__slider.thumbPos
+
+        self.publish(widget.Slider.THUMB_POS_CHANGED)
+
+    def getThumbPos(self):
+        return self.__slider.thumbPos
+    thumbPos = property(getThumbPos)
+
+    def __onSliderMove(self, thumbPos):
+        self.notifySubscribers(widget.Slider.THUMB_POS_CHANGED, [thumbPos,])
+        self.__valueDisplay.text = self.__formatStr%thumbPos
+
+
+class JitterFilter(app.MainDiv):
+    def onArgvParsed(self, options, args, parser):
+        if self.settings.getBoolean("app_fullscreen"):
+            self.settings.set("app_resolution", "") # use screen resolution
+
+    def onInit(self):
+        self.__minCutoffSlider = LabledSlider(label="Minimum Cutoff", range=(0.3, 8.0),
+                formatStr="%.1f", pos=(10,10), parent=self)
+        self.__minCutoffSlider.subscribe(widget.Slider.THUMB_POS_CHANGED, 
+                self.__onSliderMove)
+        self.__cutoffSlopeSlider = LabledSlider(label="Cutoff Slope", range=(0.0, 0.05),
+                formatStr="%.3f", pos=(10,50), parent=self)
+        self.__minCutoffSlider.subscribe(widget.Slider.THUMB_POS_CHANGED, 
+                self.__onSliderMove)
+        self.__onSliderMove(avg.Point2D(0,0))
+
+        self.subscribe(avg.Node.CURSOR_DOWN, self.__onDown)
+        self.__contact = None
+        self.__rawContactCircle = avg.CircleNode(r=7*player.getPixelsPerMM(), 
+                color="FF0000", opacity=0, parent=self)
+        self.__filteredContactCircle = avg.CircleNode(r=7*player.getPixelsPerMM(), 
+                color="00FF00", opacity=0, parent=self)
+        self.__filters = None
+
+    def __onSliderMove(self, pos):
+        self.__minCutoff = self.__minCutoffSlider.thumbPos
+        self.__cutoffSlope = self.__cutoffSlopeSlider.thumbPos
+
+    def __onDown(self, event):
+        if self.__contact is None:
+            self.__contact = event.contact
+            event.contact.subscribe(avg.Contact.CURSOR_UP, self.__onUp)
+            self.__rawContactCircle.opacity = 1
+            self.__filteredContactCircle.opacity = 1
+            self.__filters = [
+                    filter.OneEuroFilter(self.__minCutoff,self.__cutoffSlope),
+                    filter.OneEuroFilter(self.__minCutoff,self.__cutoffSlope)]
+            self.__onFrame = player.subscribe(player.ON_FRAME, self.__moveContact)
+
+    def __onUp(self, event):
+        self.__rawContactCircle.opacity = 0
+        self.__filteredContactCircle.opacity = 0
+        self.__contact = None
+        self.__filters = None
+        player.unsubscribe(self.__onFrame)
+
+    def __moveContact(self):
+        time = player.getFrameTime()
+        rawPos = self.__contact.events[-1].pos
+        self.__rawContactCircle.pos = rawPos
+        filteredPos = avg.Point2D(self.__filters[0].apply(rawPos.x, time),
+                self.__filters[1].apply(rawPos.y, time))
+        self.__filteredContactCircle.pos = filteredPos
+
+
+if __name__ == "__main__":
+    app.App().run(JitterFilter(),
+            app_resolution="800x600",
+            app_show_cursor="true",
+            multitouch_enabled="true")
+