Wideband autonomous SDR analysis engine forked from sdr-visual-suite
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.

568 rindas
14KB

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