dmi: apply filter to REF
This commit is contained in:
parent
cbf9ff439f
commit
6896d28ec2
10
dmi.py
10
dmi.py
|
@ -14,9 +14,15 @@ def main():
|
||||||
|
|
||||||
freq_sample = 1e6
|
freq_sample = 1e6
|
||||||
freq_base = 1088230e3
|
freq_base = 1088230e3
|
||||||
|
freq_ref = 1088100e3
|
||||||
block_size = 4096
|
block_size = 4096
|
||||||
throttle_factor = ceil(freq_sample/125e3)
|
throttle_factor = ceil(freq_sample/125e3)
|
||||||
|
|
||||||
|
# note: image band still goes through
|
||||||
|
freq_ref_abs = np.abs(freq_ref-freq_base)
|
||||||
|
ref_filter = LinearPhaseFilter(127, [freq_ref_abs-15e3, freq_ref_abs+15e3], pass_zero=False, fs=freq_sample)
|
||||||
|
meas_delay = Delay(block_size, ref_filter.delay())
|
||||||
|
|
||||||
gui = GUI(freq_sample, freq_base, block_size)
|
gui = GUI(freq_sample, freq_base, block_size)
|
||||||
try:
|
try:
|
||||||
induction = InductionHeater("/dev/ttyUSB0", 350e3, 445e3)
|
induction = InductionHeater("/dev/ttyUSB0", 350e3, 445e3)
|
||||||
|
@ -26,7 +32,7 @@ def main():
|
||||||
gui.update_ref(spectrum, peak_freq, locked)
|
gui.update_ref(spectrum, peak_freq, locked)
|
||||||
induction.set(tuning)
|
induction.set(tuning)
|
||||||
|
|
||||||
stabilizer = Stabilizer(freq_sample, block_size, 1088.1e6 - freq_base, stabilizer_cb)
|
stabilizer = Stabilizer(freq_sample, block_size, freq_ref-freq_base, stabilizer_cb)
|
||||||
position_tracker = PositionTracker()
|
position_tracker = PositionTracker()
|
||||||
|
|
||||||
sdr = SoapySDR.Device()
|
sdr = SoapySDR.Device()
|
||||||
|
@ -56,7 +62,7 @@ def main():
|
||||||
gui.update_meas(samples_meas)
|
gui.update_meas(samples_meas)
|
||||||
|
|
||||||
if stabilizer.locked():
|
if stabilizer.locked():
|
||||||
position = position_tracker.input(samples_ref, samples_meas)
|
position = position_tracker.input(ref_filter.input(samples_ref), meas_delay.input(samples_meas))
|
||||||
position_acc += np.mean(position)
|
position_acc += np.mean(position)
|
||||||
if throttle == 0:
|
if throttle == 0:
|
||||||
gui.update_position(position_acc/throttle_factor)
|
gui.update_position(position_acc/throttle_factor)
|
||||||
|
|
Loading…
Reference in New Issue