Nevar pievienot vairāk kā 25 tēmas Tēmai ir jāsākas ar burtu vai ciparu, tā var saturēt domu zīmes ('-') un var būt līdz 35 simboliem gara.

583 rindas
15KB

  1. package main
  2. import (
  3. "context"
  4. "encoding/json"
  5. "flag"
  6. "log"
  7. "net/http"
  8. "os"
  9. "os/signal"
  10. "path/filepath"
  11. "strconv"
  12. "strings"
  13. "sync"
  14. "syscall"
  15. "time"
  16. "github.com/gorilla/websocket"
  17. "sdr-visual-suite/internal/config"
  18. "sdr-visual-suite/internal/detector"
  19. "sdr-visual-suite/internal/dsp"
  20. "sdr-visual-suite/internal/events"
  21. fftutil "sdr-visual-suite/internal/fft"
  22. "sdr-visual-suite/internal/fft/gpufft"
  23. "sdr-visual-suite/internal/mock"
  24. "sdr-visual-suite/internal/runtime"
  25. "sdr-visual-suite/internal/sdr"
  26. "sdr-visual-suite/internal/sdrplay"
  27. )
  28. type SpectrumFrame struct {
  29. Timestamp int64 `json:"ts"`
  30. CenterHz float64 `json:"center_hz"`
  31. SampleHz int `json:"sample_rate"`
  32. FFTSize int `json:"fft_size"`
  33. Spectrum []float64 `json:"spectrum_db"`
  34. Signals []detector.Signal `json:"signals"`
  35. }
  36. type hub struct {
  37. mu sync.Mutex
  38. clients map[*websocket.Conn]struct{}
  39. }
  40. type gpuStatus struct {
  41. mu sync.RWMutex
  42. Available bool `json:"available"`
  43. Active bool `json:"active"`
  44. Error string `json:"error"`
  45. }
  46. func (g *gpuStatus) set(active bool, err error) {
  47. g.mu.Lock()
  48. defer g.mu.Unlock()
  49. g.Active = active
  50. if err != nil {
  51. g.Error = err.Error()
  52. } else {
  53. g.Error = ""
  54. }
  55. }
  56. func (g *gpuStatus) snapshot() gpuStatus {
  57. g.mu.RLock()
  58. defer g.mu.RUnlock()
  59. return gpuStatus{Available: g.Available, Active: g.Active, Error: g.Error}
  60. }
  61. func newHub() *hub {
  62. return &hub{clients: map[*websocket.Conn]struct{}{}}
  63. }
  64. func (h *hub) add(c *websocket.Conn) {
  65. h.mu.Lock()
  66. defer h.mu.Unlock()
  67. h.clients[c] = struct{}{}
  68. }
  69. func (h *hub) remove(c *websocket.Conn) {
  70. h.mu.Lock()
  71. defer h.mu.Unlock()
  72. delete(h.clients, c)
  73. }
  74. func (h *hub) broadcast(frame SpectrumFrame) {
  75. h.mu.Lock()
  76. clients := make([]*websocket.Conn, 0, len(h.clients))
  77. for c := range h.clients {
  78. clients = append(clients, c)
  79. }
  80. h.mu.Unlock()
  81. b, _ := json.Marshal(frame)
  82. for _, c := range clients {
  83. _ = c.SetWriteDeadline(time.Now().Add(200 * time.Millisecond))
  84. if err := c.WriteMessage(websocket.TextMessage, b); err != nil {
  85. h.remove(c)
  86. }
  87. }
  88. }
  89. type sourceManager struct {
  90. mu sync.RWMutex
  91. src sdr.Source
  92. newSource func(cfg config.Config) (sdr.Source, error)
  93. }
  94. func (m *sourceManager) Restart(cfg config.Config) error {
  95. m.mu.Lock()
  96. defer m.mu.Unlock()
  97. old := m.src
  98. _ = old.Stop()
  99. next, err := m.newSource(cfg)
  100. if err != nil {
  101. _ = old.Start()
  102. m.src = old
  103. return err
  104. }
  105. if err := next.Start(); err != nil {
  106. _ = next.Stop()
  107. _ = old.Start()
  108. m.src = old
  109. return err
  110. }
  111. m.src = next
  112. return nil
  113. }
  114. func (m *sourceManager) Stats() sdr.SourceStats {
  115. m.mu.RLock()
  116. defer m.mu.RUnlock()
  117. if sp, ok := m.src.(sdr.StatsProvider); ok {
  118. return sp.Stats()
  119. }
  120. return sdr.SourceStats{}
  121. }
  122. func (m *sourceManager) Flush() {
  123. m.mu.RLock()
  124. defer m.mu.RUnlock()
  125. if fl, ok := m.src.(sdr.Flushable); ok {
  126. fl.Flush()
  127. }
  128. }
  129. func newSourceManager(src sdr.Source, newSource func(cfg config.Config) (sdr.Source, error)) *sourceManager {
  130. return &sourceManager{src: src, newSource: newSource}
  131. }
  132. func (m *sourceManager) Start() error {
  133. m.mu.RLock()
  134. defer m.mu.RUnlock()
  135. return m.src.Start()
  136. }
  137. func (m *sourceManager) Stop() error {
  138. m.mu.RLock()
  139. defer m.mu.RUnlock()
  140. return m.src.Stop()
  141. }
  142. func (m *sourceManager) ReadIQ(n int) ([]complex64, error) {
  143. m.mu.RLock()
  144. defer m.mu.RUnlock()
  145. return m.src.ReadIQ(n)
  146. }
  147. func (m *sourceManager) ApplyConfig(cfg config.Config) error {
  148. m.mu.Lock()
  149. defer m.mu.Unlock()
  150. if updatable, ok := m.src.(sdr.ConfigurableSource); ok {
  151. if err := updatable.UpdateConfig(cfg.SampleRate, cfg.CenterHz, cfg.GainDb, cfg.AGC, cfg.TunerBwKHz); err == nil {
  152. return nil
  153. }
  154. }
  155. old := m.src
  156. _ = old.Stop()
  157. next, err := m.newSource(cfg)
  158. if err != nil {
  159. _ = old.Start()
  160. return err
  161. }
  162. if err := next.Start(); err != nil {
  163. _ = next.Stop()
  164. _ = old.Start()
  165. return err
  166. }
  167. m.src = next
  168. return nil
  169. }
  170. type dspUpdate struct {
  171. cfg config.Config
  172. det *detector.Detector
  173. window []float64
  174. dcBlock bool
  175. iqBalance bool
  176. useGPUFFT bool
  177. }
  178. func pushDSPUpdate(ch chan dspUpdate, update dspUpdate) {
  179. select {
  180. case ch <- update:
  181. default:
  182. select {
  183. case <-ch:
  184. default:
  185. }
  186. ch <- update
  187. }
  188. }
  189. func main() {
  190. var cfgPath string
  191. var mockFlag bool
  192. flag.StringVar(&cfgPath, "config", "config.yaml", "path to config YAML")
  193. flag.BoolVar(&mockFlag, "mock", false, "use synthetic IQ source")
  194. flag.Parse()
  195. cfg, err := config.Load(cfgPath)
  196. if err != nil {
  197. log.Fatalf("load config: %v", err)
  198. }
  199. cfgManager := runtime.New(cfg)
  200. gpuState := &gpuStatus{Available: gpufft.Available()}
  201. newSource := func(cfg config.Config) (sdr.Source, error) {
  202. if mockFlag {
  203. src := mock.New(cfg.SampleRate)
  204. if updatable, ok := interface{}(src).(sdr.ConfigurableSource); ok {
  205. _ = updatable.UpdateConfig(cfg.SampleRate, cfg.CenterHz, cfg.GainDb, cfg.AGC, cfg.TunerBwKHz)
  206. }
  207. return src, nil
  208. }
  209. src, err := sdrplay.New(cfg.SampleRate, cfg.CenterHz, cfg.GainDb, cfg.TunerBwKHz)
  210. if err != nil {
  211. return nil, err
  212. }
  213. if updatable, ok := src.(sdr.ConfigurableSource); ok {
  214. _ = updatable.UpdateConfig(cfg.SampleRate, cfg.CenterHz, cfg.GainDb, cfg.AGC, cfg.TunerBwKHz)
  215. }
  216. return src, nil
  217. }
  218. src, err := newSource(cfg)
  219. if err != nil {
  220. log.Fatalf("sdrplay init failed: %v (try --mock or build with -tags sdrplay)", err)
  221. }
  222. srcMgr := newSourceManager(src, newSource)
  223. if err := srcMgr.Start(); err != nil {
  224. log.Fatalf("source start: %v", err)
  225. }
  226. defer srcMgr.Stop()
  227. if err := os.MkdirAll(filepath.Dir(cfg.EventPath), 0o755); err != nil {
  228. log.Fatalf("event path: %v", err)
  229. }
  230. eventFile, err := os.OpenFile(cfg.EventPath, os.O_CREATE|os.O_APPEND|os.O_WRONLY, 0o644)
  231. if err != nil {
  232. log.Fatalf("open events: %v", err)
  233. }
  234. defer eventFile.Close()
  235. det := detector.New(cfg.Detector.ThresholdDb, cfg.SampleRate, cfg.FFTSize,
  236. time.Duration(cfg.Detector.MinDurationMs)*time.Millisecond,
  237. time.Duration(cfg.Detector.HoldMs)*time.Millisecond)
  238. window := fftutil.Hann(cfg.FFTSize)
  239. h := newHub()
  240. dspUpdates := make(chan dspUpdate, 1)
  241. ctx, cancel := context.WithCancel(context.Background())
  242. defer cancel()
  243. go runDSP(ctx, srcMgr, cfg, det, window, h, eventFile, dspUpdates, gpuState)
  244. upgrader := websocket.Upgrader{CheckOrigin: func(r *http.Request) bool { return true }}
  245. http.HandleFunc("/ws", func(w http.ResponseWriter, r *http.Request) {
  246. c, err := upgrader.Upgrade(w, r, nil)
  247. if err != nil {
  248. return
  249. }
  250. h.add(c)
  251. defer func() {
  252. h.remove(c)
  253. _ = c.Close()
  254. }()
  255. for {
  256. _, _, err := c.ReadMessage()
  257. if err != nil {
  258. return
  259. }
  260. }
  261. })
  262. http.HandleFunc("/api/config", func(w http.ResponseWriter, r *http.Request) {
  263. w.Header().Set("Content-Type", "application/json")
  264. switch r.Method {
  265. case http.MethodGet:
  266. _ = json.NewEncoder(w).Encode(cfgManager.Snapshot())
  267. case http.MethodPost:
  268. var update runtime.ConfigUpdate
  269. if err := json.NewDecoder(r.Body).Decode(&update); err != nil {
  270. http.Error(w, "invalid json", http.StatusBadRequest)
  271. return
  272. }
  273. prev := cfgManager.Snapshot()
  274. next, err := cfgManager.ApplyConfig(update)
  275. if err != nil {
  276. http.Error(w, err.Error(), http.StatusBadRequest)
  277. return
  278. }
  279. sourceChanged := prev.CenterHz != next.CenterHz || prev.SampleRate != next.SampleRate || prev.GainDb != next.GainDb || prev.AGC != next.AGC || prev.TunerBwKHz != next.TunerBwKHz
  280. if sourceChanged {
  281. if err := srcMgr.ApplyConfig(next); err != nil {
  282. cfgManager.Replace(prev)
  283. http.Error(w, "failed to apply source config", http.StatusInternalServerError)
  284. return
  285. }
  286. }
  287. detChanged := prev.Detector.ThresholdDb != next.Detector.ThresholdDb ||
  288. prev.Detector.MinDurationMs != next.Detector.MinDurationMs ||
  289. prev.Detector.HoldMs != next.Detector.HoldMs ||
  290. prev.SampleRate != next.SampleRate ||
  291. prev.FFTSize != next.FFTSize
  292. windowChanged := prev.FFTSize != next.FFTSize
  293. var newDet *detector.Detector
  294. var newWindow []float64
  295. if detChanged {
  296. newDet = detector.New(next.Detector.ThresholdDb, next.SampleRate, next.FFTSize,
  297. time.Duration(next.Detector.MinDurationMs)*time.Millisecond,
  298. time.Duration(next.Detector.HoldMs)*time.Millisecond)
  299. }
  300. if windowChanged {
  301. newWindow = fftutil.Hann(next.FFTSize)
  302. }
  303. pushDSPUpdate(dspUpdates, dspUpdate{
  304. cfg: next,
  305. det: newDet,
  306. window: newWindow,
  307. dcBlock: next.DCBlock,
  308. iqBalance: next.IQBalance,
  309. useGPUFFT: next.UseGPUFFT,
  310. })
  311. _ = json.NewEncoder(w).Encode(next)
  312. default:
  313. http.Error(w, "method not allowed", http.StatusMethodNotAllowed)
  314. }
  315. })
  316. http.HandleFunc("/api/sdr/settings", func(w http.ResponseWriter, r *http.Request) {
  317. w.Header().Set("Content-Type", "application/json")
  318. if r.Method != http.MethodPost {
  319. http.Error(w, "method not allowed", http.StatusMethodNotAllowed)
  320. return
  321. }
  322. var update runtime.SettingsUpdate
  323. if err := json.NewDecoder(r.Body).Decode(&update); err != nil {
  324. http.Error(w, "invalid json", http.StatusBadRequest)
  325. return
  326. }
  327. prev := cfgManager.Snapshot()
  328. next, err := cfgManager.ApplySettings(update)
  329. if err != nil {
  330. http.Error(w, err.Error(), http.StatusBadRequest)
  331. return
  332. }
  333. if prev.AGC != next.AGC || prev.TunerBwKHz != next.TunerBwKHz {
  334. if err := srcMgr.ApplyConfig(next); err != nil {
  335. cfgManager.Replace(prev)
  336. http.Error(w, "failed to apply sdr settings", http.StatusInternalServerError)
  337. return
  338. }
  339. }
  340. if prev.DCBlock != next.DCBlock || prev.IQBalance != next.IQBalance {
  341. pushDSPUpdate(dspUpdates, dspUpdate{
  342. cfg: next,
  343. dcBlock: next.DCBlock,
  344. iqBalance: next.IQBalance,
  345. })
  346. }
  347. _ = json.NewEncoder(w).Encode(next)
  348. })
  349. http.HandleFunc("/api/stats", func(w http.ResponseWriter, r *http.Request) {
  350. w.Header().Set("Content-Type", "application/json")
  351. _ = json.NewEncoder(w).Encode(srcMgr.Stats())
  352. })
  353. http.HandleFunc("/api/gpu", func(w http.ResponseWriter, r *http.Request) {
  354. w.Header().Set("Content-Type", "application/json")
  355. _ = json.NewEncoder(w).Encode(gpuState.snapshot())
  356. })
  357. http.HandleFunc("/api/events", func(w http.ResponseWriter, r *http.Request) {
  358. w.Header().Set("Content-Type", "application/json")
  359. limit := 200
  360. if v := r.URL.Query().Get("limit"); v != "" {
  361. if parsed, err := strconv.Atoi(v); err == nil {
  362. limit = parsed
  363. }
  364. }
  365. var since time.Time
  366. if v := r.URL.Query().Get("since"); v != "" {
  367. if parsed, err := parseSince(v); err == nil {
  368. since = parsed
  369. } else {
  370. http.Error(w, "invalid since", http.StatusBadRequest)
  371. return
  372. }
  373. }
  374. evs, err := events.ReadRecent(cfg.EventPath, limit, since)
  375. if err != nil {
  376. http.Error(w, "failed to read events", http.StatusInternalServerError)
  377. return
  378. }
  379. _ = json.NewEncoder(w).Encode(evs)
  380. })
  381. http.Handle("/", http.FileServer(http.Dir(cfg.WebRoot)))
  382. server := &http.Server{Addr: cfg.WebAddr}
  383. go func() {
  384. log.Printf("web listening on %s", cfg.WebAddr)
  385. if err := server.ListenAndServe(); err != nil && err != http.ErrServerClosed {
  386. log.Fatalf("server: %v", err)
  387. }
  388. }()
  389. stop := make(chan os.Signal, 1)
  390. signal.Notify(stop, os.Interrupt, syscall.SIGTERM)
  391. <-stop
  392. ctxTimeout, cancelTimeout := context.WithTimeout(context.Background(), 5*time.Second)
  393. defer cancelTimeout()
  394. _ = server.Shutdown(ctxTimeout)
  395. }
  396. func runDSP(ctx context.Context, srcMgr *sourceManager, cfg config.Config, det *detector.Detector, window []float64, h *hub, eventFile *os.File, updates <-chan dspUpdate, gpuState *gpuStatus) {
  397. ticker := time.NewTicker(cfg.FrameInterval())
  398. defer ticker.Stop()
  399. logTicker := time.NewTicker(5 * time.Second)
  400. defer logTicker.Stop()
  401. enc := json.NewEncoder(eventFile)
  402. dcBlocker := dsp.NewDCBlocker(0.995)
  403. dcEnabled := cfg.DCBlock
  404. iqEnabled := cfg.IQBalance
  405. useGPU := cfg.UseGPUFFT
  406. var gpuEngine *gpufft.Engine
  407. if useGPU && gpuState != nil && gpuState.Available {
  408. if eng, err := gpufft.New(cfg.FFTSize); err == nil {
  409. gpuEngine = eng
  410. gpuState.set(true, nil)
  411. } else {
  412. gpuState.set(false, err)
  413. useGPU = false
  414. }
  415. } else if gpuState != nil {
  416. gpuState.set(false, nil)
  417. }
  418. gotSamples := false
  419. for {
  420. select {
  421. case <-ctx.Done():
  422. return
  423. case <-logTicker.C:
  424. st := srcMgr.Stats()
  425. log.Printf("stats: buf=%d drop=%d reset=%d last=%dms", st.BufferSamples, st.Dropped, st.Resets, st.LastSampleAgoMs)
  426. case upd := <-updates:
  427. prevFFT := cfg.FFTSize
  428. prevUseGPU := useGPU
  429. cfg = upd.cfg
  430. if upd.det != nil {
  431. det = upd.det
  432. }
  433. if upd.window != nil {
  434. window = upd.window
  435. }
  436. dcEnabled = upd.dcBlock
  437. iqEnabled = upd.iqBalance
  438. if cfg.FFTSize != prevFFT || cfg.UseGPUFFT != prevUseGPU {
  439. srcMgr.Flush()
  440. gotSamples = false
  441. if gpuEngine != nil {
  442. gpuEngine.Close()
  443. gpuEngine = nil
  444. }
  445. useGPU = cfg.UseGPUFFT
  446. if useGPU && gpuState != nil && gpuState.Available {
  447. if eng, err := gpufft.New(cfg.FFTSize); err == nil {
  448. gpuEngine = eng
  449. gpuState.set(true, nil)
  450. } else {
  451. gpuState.set(false, err)
  452. useGPU = false
  453. }
  454. } else if gpuState != nil {
  455. gpuState.set(false, nil)
  456. }
  457. }
  458. dcBlocker.Reset()
  459. ticker.Reset(cfg.FrameInterval())
  460. case <-ticker.C:
  461. iq, err := srcMgr.ReadIQ(cfg.FFTSize)
  462. if err != nil {
  463. log.Printf("read IQ: %v", err)
  464. if strings.Contains(err.Error(), "timeout") {
  465. if err := srcMgr.Restart(cfg); err != nil {
  466. log.Printf("restart failed: %v", err)
  467. }
  468. }
  469. continue
  470. }
  471. if !gotSamples {
  472. log.Printf("received IQ samples")
  473. gotSamples = true
  474. }
  475. if dcEnabled {
  476. dcBlocker.Apply(iq)
  477. }
  478. if iqEnabled {
  479. dsp.IQBalance(iq)
  480. }
  481. var spectrum []float64
  482. if useGPU && gpuEngine != nil {
  483. if len(window) == len(iq) {
  484. for i := 0; i < len(iq); i++ {
  485. v := iq[i]
  486. w := float32(window[i])
  487. iq[i] = complex(real(v)*w, imag(v)*w)
  488. }
  489. }
  490. out, err := gpuEngine.Exec(iq)
  491. if err != nil {
  492. if gpuState != nil {
  493. gpuState.set(false, err)
  494. }
  495. useGPU = false
  496. spectrum = fftutil.Spectrum(iq, window)
  497. } else {
  498. spectrum = fftutil.SpectrumFromFFT(out)
  499. }
  500. } else {
  501. spectrum = fftutil.Spectrum(iq, window)
  502. }
  503. now := time.Now()
  504. finished, signals := det.Process(now, spectrum, cfg.CenterHz)
  505. for _, ev := range finished {
  506. _ = enc.Encode(ev)
  507. }
  508. h.broadcast(SpectrumFrame{
  509. Timestamp: now.UnixMilli(),
  510. CenterHz: cfg.CenterHz,
  511. SampleHz: cfg.SampleRate,
  512. FFTSize: cfg.FFTSize,
  513. Spectrum: spectrum,
  514. Signals: signals,
  515. })
  516. }
  517. }
  518. }
  519. func parseSince(raw string) (time.Time, error) {
  520. if raw == "" {
  521. return time.Time{}, nil
  522. }
  523. if ms, err := strconv.ParseInt(raw, 10, 64); err == nil {
  524. if ms > 1e12 {
  525. return time.UnixMilli(ms), nil
  526. }
  527. return time.Unix(ms, 0), nil
  528. }
  529. if t, err := time.Parse(time.RFC3339Nano, raw); err == nil {
  530. return t, nil
  531. }
  532. return time.Parse(time.RFC3339, raw)
  533. }