wrpll: add filter algorithms (WIP)

artiq/gateware/wrpll/filters.py

@@ -0,0 +1,54 @@
+main_xn1 = 0
+main_xn2 = 0
+main_yn0 = 0
+main_yn1 = 0
+main_yn2 = 0
+
+main_y0 = 23
+main_yr = 43
+
+def filter_main(xn0):
+    global main_xn1, main_xn2, main_yn0, main_yn1, main_yn2
+
+    main_yn2 = main_yn1
+    main_yn1 = main_yn0
+    main_yn0 = (
+        ((133450380908*((35184372088832*xn0 >> 44) + (17592186044417*main_xn1 >> 44))) >> 44)
+        + (29455872930889*main_yn1 >> 44)
+        - (12673794781453*main_yn2 >> 44))
+
+    main_xn2 = main_xn1
+    main_xn1 = xn0
+
+    main_yn0 = min(main_yn0, main_y0 + main_yr)
+    main_yn0 = max(main_yn0, main_y0 - main_yr)
+   
+    return main_yn0
+
+
+helper_xn1 = 0
+helper_xn2 = 0
+helper_yn0 = 0
+helper_yn1 = 0
+helper_yn2 = 0
+
+helper_y0 = 23
+helper_yr = 43
+
+def filter_helper(xn0):
+    global helper_xn1, helper_xn2, helper_yn0, helper_yn1, helper_yn2
+
+    helper_yn2 = helper_yn1
+    helper_yn1 = helper_yn0
+    helper_yn0 = (
+        ((133450380908*((35184372088832*xn0 >> 44) + (17592186044417*helper_xn1 >> 44))) >> 44)
+        + (29455872930889*helper_yn1 >> 44)
+        - (12673794781453*helper_yn2 >> 44))
+
+    helper_xn2 = helper_xn1
+    helper_xn1 = xn0
+
+    helper_yn0 = min(helper_yn0, helper_y0 + helper_yr)
+    helper_yn0 = max(helper_yn0, helper_y0 - helper_yr)
+   
+    return helper_yn0