re-enable position tracker
This commit is contained in:
parent
b28d0ad337
commit
79a61a4073
7
dmi.py
7
dmi.py
|
@ -49,8 +49,11 @@ def main():
|
|||
# Update the MEAS GUI at the same time so it's synchronized
|
||||
gui.update_meas(samples_meas)
|
||||
|
||||
#position, leakage = position_tracker.input(samples_ref, samples_meas)
|
||||
#print(np.sum(position)/len(position), leakage)
|
||||
if stabilizer.locked():
|
||||
position, leakage = position_tracker.input(samples_ref, samples_meas)
|
||||
print(np.sum(position)/len(position), leakage)
|
||||
else:
|
||||
position_tracker.reset()
|
||||
finally:
|
||||
buf_sdr.dispose(buffers)
|
||||
finally:
|
||||
|
|
|
@ -170,9 +170,13 @@ def continuous_unwrap(last_phase, last_phase_unwrapped, p):
|
|||
|
||||
class PositionTracker:
|
||||
def __init__(self, leakage_avg):
|
||||
self.leakage_avg = leakage_avg
|
||||
self.reset()
|
||||
|
||||
def reset(self):
|
||||
self.last_phase = 0.0
|
||||
self.last_position = 0.0
|
||||
self.leakage = np.zeros(leakage_avg)
|
||||
self.leakage = np.zeros(self.leakage_avg)
|
||||
self.leakage_ptr = 0
|
||||
|
||||
def input(self, ref, meas):
|
||||
|
|
Loading…
Reference in New Issue