Вы не можете выбрать более 25 тем Темы должны начинаться с буквы или цифры, могут содержать дефисы(-) и должны содержать не более 35 символов.

587 строки
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. if sp, ok := src.(sdr.StatsProvider); ok {
  352. _ = json.NewEncoder(w).Encode(sp.Stats())
  353. return
  354. }
  355. _ = json.NewEncoder(w).Encode(sdr.SourceStats{})
  356. })
  357. http.HandleFunc("/api/gpu", func(w http.ResponseWriter, r *http.Request) {
  358. w.Header().Set("Content-Type", "application/json")
  359. _ = json.NewEncoder(w).Encode(gpuState.snapshot())
  360. })
  361. http.HandleFunc("/api/events", func(w http.ResponseWriter, r *http.Request) {
  362. w.Header().Set("Content-Type", "application/json")
  363. limit := 200
  364. if v := r.URL.Query().Get("limit"); v != "" {
  365. if parsed, err := strconv.Atoi(v); err == nil {
  366. limit = parsed
  367. }
  368. }
  369. var since time.Time
  370. if v := r.URL.Query().Get("since"); v != "" {
  371. if parsed, err := parseSince(v); err == nil {
  372. since = parsed
  373. } else {
  374. http.Error(w, "invalid since", http.StatusBadRequest)
  375. return
  376. }
  377. }
  378. evs, err := events.ReadRecent(cfg.EventPath, limit, since)
  379. if err != nil {
  380. http.Error(w, "failed to read events", http.StatusInternalServerError)
  381. return
  382. }
  383. _ = json.NewEncoder(w).Encode(evs)
  384. })
  385. http.Handle("/", http.FileServer(http.Dir(cfg.WebRoot)))
  386. server := &http.Server{Addr: cfg.WebAddr}
  387. go func() {
  388. log.Printf("web listening on %s", cfg.WebAddr)
  389. if err := server.ListenAndServe(); err != nil && err != http.ErrServerClosed {
  390. log.Fatalf("server: %v", err)
  391. }
  392. }()
  393. stop := make(chan os.Signal, 1)
  394. signal.Notify(stop, os.Interrupt, syscall.SIGTERM)
  395. <-stop
  396. ctxTimeout, cancelTimeout := context.WithTimeout(context.Background(), 5*time.Second)
  397. defer cancelTimeout()
  398. _ = server.Shutdown(ctxTimeout)
  399. }
  400. 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) {
  401. ticker := time.NewTicker(cfg.FrameInterval())
  402. defer ticker.Stop()
  403. logTicker := time.NewTicker(5 * time.Second)
  404. defer logTicker.Stop()
  405. enc := json.NewEncoder(eventFile)
  406. dcBlocker := dsp.NewDCBlocker(0.995)
  407. dcEnabled := cfg.DCBlock
  408. iqEnabled := cfg.IQBalance
  409. useGPU := cfg.UseGPUFFT
  410. var gpuEngine *gpufft.Engine
  411. if useGPU && gpuState != nil && gpuState.Available {
  412. if eng, err := gpufft.New(cfg.FFTSize); err == nil {
  413. gpuEngine = eng
  414. gpuState.set(true, nil)
  415. } else {
  416. gpuState.set(false, err)
  417. useGPU = false
  418. }
  419. } else if gpuState != nil {
  420. gpuState.set(false, nil)
  421. }
  422. gotSamples := false
  423. for {
  424. select {
  425. case <-ctx.Done():
  426. return
  427. case <-logTicker.C:
  428. st := srcMgr.Stats()
  429. log.Printf("stats: buf=%d drop=%d reset=%d last=%dms", st.BufferSamples, st.Dropped, st.Resets, st.LastSampleAgoMs)
  430. case upd := <-updates:
  431. prevFFT := cfg.FFTSize
  432. prevUseGPU := useGPU
  433. cfg = upd.cfg
  434. if upd.det != nil {
  435. det = upd.det
  436. }
  437. if upd.window != nil {
  438. window = upd.window
  439. }
  440. dcEnabled = upd.dcBlock
  441. iqEnabled = upd.iqBalance
  442. if cfg.FFTSize != prevFFT || cfg.UseGPUFFT != prevUseGPU {
  443. srcMgr.Flush()
  444. gotSamples = false
  445. if gpuEngine != nil {
  446. gpuEngine.Close()
  447. gpuEngine = nil
  448. }
  449. useGPU = cfg.UseGPUFFT
  450. if useGPU && gpuState != nil && gpuState.Available {
  451. if eng, err := gpufft.New(cfg.FFTSize); err == nil {
  452. gpuEngine = eng
  453. gpuState.set(true, nil)
  454. } else {
  455. gpuState.set(false, err)
  456. useGPU = false
  457. }
  458. } else if gpuState != nil {
  459. gpuState.set(false, nil)
  460. }
  461. }
  462. dcBlocker.Reset()
  463. ticker.Reset(cfg.FrameInterval())
  464. case <-ticker.C:
  465. iq, err := srcMgr.ReadIQ(cfg.FFTSize)
  466. if err != nil {
  467. log.Printf("read IQ: %v", err)
  468. if strings.Contains(err.Error(), "timeout") {
  469. if err := srcMgr.Restart(cfg); err != nil {
  470. log.Printf("restart failed: %v", err)
  471. }
  472. }
  473. continue
  474. }
  475. if !gotSamples {
  476. log.Printf("received IQ samples")
  477. gotSamples = true
  478. }
  479. if dcEnabled {
  480. dcBlocker.Apply(iq)
  481. }
  482. if iqEnabled {
  483. dsp.IQBalance(iq)
  484. }
  485. var spectrum []float64
  486. if useGPU && gpuEngine != nil {
  487. if len(window) == len(iq) {
  488. for i := 0; i < len(iq); i++ {
  489. v := iq[i]
  490. w := float32(window[i])
  491. iq[i] = complex(real(v)*w, imag(v)*w)
  492. }
  493. }
  494. out, err := gpuEngine.Exec(iq)
  495. if err != nil {
  496. if gpuState != nil {
  497. gpuState.set(false, err)
  498. }
  499. useGPU = false
  500. spectrum = fftutil.Spectrum(iq, window)
  501. } else {
  502. spectrum = fftutil.SpectrumFromFFT(out)
  503. }
  504. } else {
  505. spectrum = fftutil.Spectrum(iq, window)
  506. }
  507. now := time.Now()
  508. finished, signals := det.Process(now, spectrum, cfg.CenterHz)
  509. for _, ev := range finished {
  510. _ = enc.Encode(ev)
  511. }
  512. h.broadcast(SpectrumFrame{
  513. Timestamp: now.UnixMilli(),
  514. CenterHz: cfg.CenterHz,
  515. SampleHz: cfg.SampleRate,
  516. FFTSize: cfg.FFTSize,
  517. Spectrum: spectrum,
  518. Signals: signals,
  519. })
  520. }
  521. }
  522. }
  523. func parseSince(raw string) (time.Time, error) {
  524. if raw == "" {
  525. return time.Time{}, nil
  526. }
  527. if ms, err := strconv.ParseInt(raw, 10, 64); err == nil {
  528. if ms > 1e12 {
  529. return time.UnixMilli(ms), nil
  530. }
  531. return time.Unix(ms, 0), nil
  532. }
  533. if t, err := time.Parse(time.RFC3339Nano, raw); err == nil {
  534. return t, nil
  535. }
  536. return time.Parse(time.RFC3339, raw)
  537. }