diff --git a/artiq/gateware/wrpll/filters.py b/artiq/gateware/wrpll/filters.py new file mode 100644 index 000000000..64dbe7c85 --- /dev/null +++ b/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