#!/usr/bin/env python3
"""FM mono kuulamine: rtl_fm diskriminaatori väljund (240 kHz) -> de-emfaas 50 us -> LPF 15 kHz -> 48 kHz S16 stdouti.

Kasutus: rtl_fm -M fm -f 101.6M -g 37.2 -s 240k - | fm_play.py | aplay -r 48000 -f S16_LE -t raw -c 1
Asendab rtl_fm -M wbfm -r 48k, mille resampler jättis kuuldavad 8/16/24 kHz toonid ja 19 kHz piloodi sisse.
"""
import sys
import numpy as np
from scipy.signal import firwin, lfilter, lfilter_zi

FS_IN, DECIM = 240_000, 5          # 240k / 5 = 48k
TAU = 50e-6                        # Euroopa de-emfaas
BLOCK = FS_IN // 20                # 50 ms

a = np.exp(-1 / (FS_IN * TAU))
de_b, de_a = [1 - a], [1, -a]
lp = firwin(255, 15_000, fs=FS_IN)

de_z = lfilter_zi(de_b, de_a) * 0
lp_z = np.zeros(len(lp) - 1)
phase = 0
inp, out = sys.stdin.buffer, sys.stdout.buffer

while True:
    raw = inp.read(BLOCK * 2)
    if not raw:
        break
    x = np.frombuffer(raw[:len(raw) // 2 * 2], dtype=np.int16).astype(np.float32) / 32768
    x, de_z = lfilter(de_b, de_a, x, zi=de_z)
    x, lp_z = lfilter(lp, 1.0, x, zi=lp_z)
    y = x[phase::DECIM]
    phase = (phase - len(x)) % DECIM
    out.write((np.clip(y * 2.0, -1, 1) * 32767).astype(np.int16).tobytes())
    out.flush()
