forked from M-Labs/artiq
1
0
Fork 0

wrpll: add filter algorithms (WIP)

This commit is contained in:
Sebastien Bourdeauducq 2019-08-02 13:23:16 +08:00
parent 7a5dcbe60e
commit f861459ace
1 changed files with 54 additions and 0 deletions

View File

@ -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