M-Labs
/
nix-servo
3
1
Fork 2
Code Issues Pull Requests Packages Projects Releases Wiki Activity

pyfastservo adc: Fix find edge bug 

- Fix: if frame changed at 31 tap delay, edge would not get detected
This commit is contained in:
linuswck 2024-11-08 12:41:07 +08:00
parent 6cef418756
commit 382e8467d9
1 changed files with 5 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
fast-servo/pyfastservo/adc.py
View File

@ -87,21 +87,18 @@ def perform_bitslip():
def find_edge(): def find_edge():
prev_frame = read_frame() prev_frame = read_frame()
transition = False
for tap_delay in range(32): for tap_delay in range(32):
write_to_memory(ADC_DELAY_ADDR, tap_delay) write_to_memory(ADC_DELAY_ADDR, tap_delay)
current_frame = read_frame() current_frame = read_frame()
print(f"Tap delay: {tap_delay}, Current frame: 0x{current_frame:02x}") print(f"Tap delay: {tap_delay}, Current frame: 0x{current_frame:02x}")
print(f"prev_frame: 0x{prev_frame:02x}")
if current_frame != prev_frame: if current_frame != prev_frame:
if not transition: final_delay = ((tap_delay+1) // 2) + 2
transition = True print(f"Edge detected; setting iDelay to: {final_delay}")
else: write_to_memory(ADC_DELAY_ADDR, final_delay)
final_delay = (tap_delay // 2) + 2 return
print(f"Edge detected; setting iDelay to: {final_delay}")
write_to_memory(ADC_DELAY_ADDR, final_delay)
return
prev_frame = current_frame prev_frame = current_frame