![[BACK]](/cvsweb/icons/back.gif){kind=icon}
Return to sound.cpp CVS log ![[TXT]](/cvsweb/icons/text.gif){kind=icon}
![[DIR]](/cvsweb/icons/dir.gif){kind=icon}
Up to [Isaki's NoNo m68k/m88k emulator] / nono / vm|
Return to sound.cpp CVS log | Up to [Isaki's NoNo m68k/m88k emulator] / nono / vm |
1.1 ! root 1: // ! 2: // nono ! 3: // Copyright (C) 2025 nono project ! 4: // Licensed under nono-license.txt ! 5: // ! 6: ! 7: // ! 8: // サウンドレンダラ ! 9: // ! 10: ! 11: // vtime / BLK_NSEC をブロック時刻と呼ぶことにする。 ! 12: // ! 13: // 各サウンドトラックは 2 (=NSRCBLKS) ブロック分のバッファを持つ。 ! 14: // ブロック境界の 000'000_nsec ちょうどにソースデバイスとサウンドレンダラの ! 15: // イベントが重なってどちらの順で実行しても構わないようにするため。 ! 16: // ! 17: // サウンドレンダラのソース合成バッファは 1ブロックでいい (NMIXBLKS)。 ! 18: // ! 19: // サウンドレンダラからホストドライバへの出力リングバッファは ! 20: // 4 (=NOUTBLKS) ブロック。少なくとも 3 あればいいのできりをよくする。 ! 21: ! 22: #include "sound.h" ! 23: #include "event.h" ! 24: #include "hostsound.h" ! 25: #include "mainapp.h" ! 26: #include "monitor.h" ! 27: #include "scheduler.h" ! 28: #include "syncer.h" ! 29: #include <algorithm> ! 30: #include <cmath> ! 31: ! 32: #define SAMPLES_TO_BYTES(samples) ((samples) * sizeof(int16)) ! 33: #define SAMPLES_TO_FRAMES(samples) ((samples) / NCHAN) ! 34: #define FRAMES_TO_SAMPLES(frames) ((frames) * NCHAN) ! 35: ! 36: // ! 37: // サウンドトラック ! 38: // ! 39: ! 40: // コンストラクタ ! 41: SoundTrack::SoundTrack(Device *dev_, size_t mixer_samples_per_blk) ! 42: { ! 43: dev = dev_; ! 44: samples_per_blk = mixer_samples_per_blk; ! 45: ! 46: // 例外はこれをコンストラクトするところで catch してある。 ! 47: buf.reset(new int16[samples_per_blk * NSRCBLKS]); ! 48: ! 49: std::fill(blkseq.begin(), blkseq.end(), (uint64)-1); ! 50: SoundRenderer::ClearDBFS(dbfs); ! 51: } ! 52: ! 53: // バッファの idx 番目のブロック先頭を返す。 ! 54: // 時刻や使用状況によらない。 ! 55: int16 * ! 56: SoundTrack::GetBlockByIdx(uint32 idx) ! 57: { ! 58: assert(idx < NSRCBLKS); ! 59: auto p = buf.get() + idx * samples_per_blk; ! 60: return p; ! 61: } ! 62: ! 63: // ブロック時刻 vseq のブロック先頭を返す。有効でなければ NULL を返す。 ! 64: int16 * ! 65: SoundTrack::GetBlockBySeq(uint64 vseq) ! 66: { ! 67: uint32 idx = vseq % NSRCBLKS; ! 68: ! 69: if (blkseq[idx] == vseq) { ! 70: return GetBlockByIdx(idx); ! 71: } ! 72: return NULL; ! 73: } ! 74: ! 75: // 時刻 vseq をブロックと紐付けて (すでに紐付いていれば何もしない)、 ! 76: // このブロックの先頭を返す。 ! 77: int16 * ! 78: SoundTrack::AllocSeq(uint64 vseq) ! 79: { ! 80: uint32 idx = vseq % NSRCBLKS; ! 81: ! 82: if (__predict_true(blkseq[idx] == (uint64)-1)) { ! 83: // バッファは消去済み。 ! 84: blkseq[idx] = vseq; ! 85: } else if (blkseq[idx] != vseq) { ! 86: // バッファが未消去なので書きつぶす。(通常起きないはず) ! 87: ClearSeq(vseq); ! 88: blkseq[idx] = vseq; ! 89: } ! 90: ! 91: return GetBlockByIdx(idx); ! 92: } ! 93: ! 94: // 時刻 vseq のブロックの紐付けをクリアする。 ! 95: // (サウンドスレッドから呼ばれるはず) ! 96: void ! 97: SoundTrack::ClearSeq(uint64 vseq) ! 98: { ! 99: uint32 idx = vseq % NSRCBLKS; ! 100: ! 101: int16 *blk = GetBlockByIdx(idx); ! 102: memset(blk, 0, SAMPLES_TO_BYTES(samples_per_blk)); ! 103: blkseq[idx] = (int64)-1; ! 104: } ! 105: ! 106: ! 107: // ! 108: // サウンドレンダラ ! 109: // ! 110: ! 111: // コンストラクタ ! 112: SoundRenderer::SoundRenderer() ! 113: : inherited(OBJ_SOUND_RENDERER) ! 114: { ! 115: // ミキサー周波数は機種ごとに違う。 ! 116: if (gMainApp.IsX68030()) { ! 117: // X68030 では 62.5kHz を使う。(adpcm.cpp 参照) ! 118: mixerfreq = 62500; ! 119: } else { ! 120: assert(false); ! 121: } ! 122: ! 123: ClearDBFS(master_dbfs); ! 124: ! 125: monitor = gMonitorManager->Regist(ID_MONITOR_SOUND, this); ! 126: monitor->func = ToMonitorCallback(&SoundRenderer::MonitorUpdate); ! 127: monitor->SetSize(40, 2); ! 128: } ! 129: ! 130: // デストラクタ ! 131: SoundRenderer::~SoundRenderer() ! 132: { ! 133: TerminateThread(); ! 134: } ! 135: ! 136: bool ! 137: SoundRenderer::Create() ! 138: { ! 139: try { ! 140: hostsnd.reset(new HostSoundDevice(this)); ! 141: } catch (...) { } ! 142: if ((bool)hostsnd == false) { ! 143: warnx("Failed to initialize HostSoundDevice at %s", __method__); ! 144: return false; ! 145: } ! 146: ! 147: return true; ! 148: } ! 149: ! 150: void ! 151: SoundRenderer::SetLogLevel(int loglevel_) ! 152: { ! 153: inherited::SetLogLevel(loglevel_); ! 154: ! 155: if ((bool)hostsnd) { ! 156: hostsnd->SetLogLevel(loglevel_); ! 157: } ! 158: } ! 159: ! 160: // 初期化 ! 161: bool ! 162: SoundRenderer::Init() ! 163: { ! 164: syncer = GetSyncer(); ! 165: ! 166: // トラック合成用バッファ。(1ブロック分) ! 167: auto mixer_frames_per_blk = (uint64)mixerfreq * BLK_NSEC / 1_sec; ! 168: mixer_samples_per_blk = FRAMES_TO_SAMPLES(mixer_frames_per_blk); ! 169: mixbuf.reset(new(std::nothrow) int16[mixer_samples_per_blk]); ! 170: if (mixbuf == NULL) { ! 171: warnx("Failed to allocate %zu bytes at %s", ! 172: SAMPLES_TO_BYTES(mixer_samples_per_blk), __method__); ! 173: return false; ! 174: } ! 175: ! 176: // 出力バッファなど実行時にも変わるものを設定。 ! 177: request_outfreq = mixerfreq; // XXX 周波数変換はまだ ! 178: if (Reconfig(true) == false) { ! 179: return false; ! 180: } ! 181: ! 182: auto evman = GetEventManager(); ! 183: play_event = evman->Regist(this, ! 184: ToEventCallback(&SoundRenderer::Callback), ! 185: "Sound Renderer"); ! 186: ! 187: return true; ! 188: } ! 189: ! 190: // リセット ! 191: void ! 192: SoundRenderer::ResetHard(bool poweron) ! 193: { ! 194: // 各デバイスがリセット時に Stop*() を呼ぶので ! 195: // 自動的にこっちも停止するはず。 ! 196: } ! 197: ! 198: // 出力周波数かホストドライバの変更 (サウンドスレッドで呼ばれる)。 ! 199: // エラーが起きた場合、 ! 200: // 起動時なら、warn() 等で表示して false を返す(終了する)。 ! 201: // 実行中なら、warn() 等で表示してもいいが、必ず None にフォールバックして ! 202: // true を返すこと。 ! 203: bool ! 204: SoundRenderer::Reconfig(bool startup) ! 205: { ! 206: assert(hostsnd->IsQEmpty()); ! 207: ! 208: // 出力周波数が変わったら出力リングバッファをリサイズ。 ! 209: // outbuf は NOUTBLKS ブロック分。 ! 210: bool need_resize = false; ! 211: if (outfreq != request_outfreq) { ! 212: outfreq = request_outfreq; ! 213: need_resize = true; ! 214: } ! 215: ! 216: auto out_frames_per_blk = (uint64)outfreq * BLK_NSEC / 1_sec; ! 217: out_samples_per_blk = FRAMES_TO_SAMPLES(out_frames_per_blk); ! 218: ! 219: if (need_resize) { ! 220: auto samples = out_samples_per_blk * NOUTBLKS; ! 221: outbuf.reset(new(std::nothrow) int16[samples]); ! 222: if (outbuf == NULL) { ! 223: warnx("Failed to allocate %zu bytes at %s", ! 224: SAMPLES_TO_BYTES(samples), __method__); ! 225: return false; ! 226: } ! 227: } ! 228: ! 229: // ホストドライバも必ず再切替になる。 ! 230: if (hostsnd->NotifyReselectDriver() == false) { ! 231: return false; ! 232: } ! 233: ! 234: return true; ! 235: } ! 236: ! 237: // サウンドトラック(ソースデバイス)を登録する。 ! 238: // 登録された SoundTrack へのポインタを返す。 ! 239: // 各ソースデバイスが Init() で呼ぶ。 ! 240: // Unregist 操作はない。 ! 241: SoundTrack * ! 242: SoundRenderer::RegistTrack(Device *dev) ! 243: { ! 244: assert(tracks.size() < MAX_SOUND_SOURCES); ! 245: ! 246: try { ! 247: // この emplace_back が new SoundTrack(..)。 ! 248: tracks.emplace_back(dev, mixer_samples_per_blk); ! 249: } catch (...) { ! 250: warnx("Failed to initialize SoundTrack"); ! 251: return NULL; ! 252: } ! 253: ! 254: monitor->AddHeight(3); ! 255: ! 256: return &tracks.back(); ! 257: } ! 258: ! 259: // 再生を開始する。 ! 260: // 各サウンドデバイスが呼ぶ。 ! 261: void ! 262: SoundRenderer::StartPlay(SoundTrack *track) ! 263: { ! 264: if (track->status != Running) { ! 265: putlog(1, "Playing [%s]", track->GetName().c_str()); ! 266: track->status = Running; ! 267: } ! 268: if (play_event->IsRunning() == false) { ! 269: // ミキサーイベントが停止してたらイベントを起動する。 ! 270: // 最初の1回は、ブロック境界になるようにする。 ! 271: play_event->time = BLK_NSEC - (scheduler->GetVirtTime() % BLK_NSEC); ! 272: ! 273: scheduler->StartEvent(play_event); ! 274: syncer->NotifySoundRunning(true); ! 275: } ! 276: } ! 277: ! 278: // 再生を停止する。 ! 279: // 各サウンドデバイスが呼ぶ。 ! 280: void ! 281: SoundRenderer::StopPlay(SoundTrack *track) ! 282: { ! 283: if (track->status == Running) { ! 284: putlog(1, "Draining [%s]", track->GetName().c_str()); ! 285: track->status = Draining; ! 286: } ! 287: } ! 288: ! 289: // ブロック先頭の時間に呼ばれて、直前のブロックを処理するコールバック。 ! 290: // (VM スレッドで呼ばれる) ! 291: void ! 292: SoundRenderer::Callback(Event *event) ! 293: { ! 294: // デバイスが全員再生停止していれば ! 295: // 裏スレッドへの通知も次のイベントループも不要でここで終了。 ! 296: bool playing = false; ! 297: for (const auto& track : tracks) { ! 298: if (track.status != Stopped) { ! 299: playing = true; ! 300: break; ! 301: } ! 302: } ! 303: if (playing == false) { ! 304: syncer->NotifySoundRunning(false); ! 305: return; ! 306: } ! 307: ! 308: // ブロック境界を繰り上がったところで呼ばれているので ! 309: // 処理したいのは一つ前のブロック。 ! 310: uint64 vseq = (scheduler->GetVirtTime() / BLK_NSEC) - 1; ! 311: ! 312: // 裏(レンダラ)スレッドに通知するだけ。 ! 313: // キューが一杯ならロストするだけ (だけ?)。 ! 314: { ! 315: std::lock_guard<std::mutex> lock(mtx); ! 316: request_q.Enqueue(vseq); ! 317: cv.notify_one(); ! 318: } ! 319: ! 320: // 次のイベント。 ! 321: event->time = BLK_NSEC; ! 322: scheduler->StartEvent(event); ! 323: } ! 324: ! 325: void ! 326: SoundRenderer::Terminate() ! 327: { ! 328: std::lock_guard<std::mutex> lock(mtx); ! 329: request |= REQ_TERMINATE; ! 330: cv.notify_one(); ! 331: } ! 332: ! 333: // サウンドスレッド ! 334: void ! 335: SoundRenderer::ThreadRun() ! 336: { ! 337: SetThreadAffinityHint(AffinityClass::Heavy); ! 338: ! 339: for (;;) { ! 340: uint32 action = 0; ! 341: uint64 vseq = -1; ! 342: { ! 343: std::unique_lock<std::mutex> lock(mtx); ! 344: cv.wait(lock, [&]() { ! 345: // 終了フラグは最優先。 ! 346: if (__predict_false((request & REQ_TERMINATE))) { ! 347: action = REQ_TERMINATE; ! 348: return true; ! 349: } ! 350: ! 351: // ドライバ変更時は出力キューが空である必要がある。 ! 352: // 入力キューより優先。 ! 353: if (__predict_false((request & REQ_RECONFIG))) { ! 354: if (hostsnd->IsQEmpty()) { ! 355: request &= ~REQ_RECONFIG; ! 356: action = REQ_RECONFIG; ! 357: return true; ! 358: } else { ! 359: return false; ! 360: } ! 361: } ! 362: ! 363: // 入力キューがあれば。 ! 364: if (request_q.Dequeue(&vseq)) { ! 365: return true; ! 366: } ! 367: return false; ! 368: }); ! 369: } ! 370: // action がここで処理すべきフラグ。 ! 371: // request のほうは必要なら下げてある。 ! 372: ! 373: // action == REQ_TERMINATE (終了要求) か ! 374: // action == REQ_SELECT_DRIVER (ドライバ変更要求) か、 ! 375: // どちらでもなければ vseq >= 0 ならデータあり。 ! 376: ! 377: if (__predict_false((action & REQ_TERMINATE))) { ! 378: break; ! 379: } else if (__predict_false((action & REQ_RECONFIG))) { ! 380: Reconfig(false); ! 381: } else if ((int64)vseq >= 0) { ! 382: Mix(vseq); ! 383: } ! 384: } ! 385: } ! 386: ! 387: // デバイス間合成してホストに出力する。 ! 388: // (Sound スレッド) ! 389: void ! 390: SoundRenderer::Mix(uint64 vseq) ! 391: { ! 392: int16 *dst; ! 393: uint dstbytes; ! 394: ! 395: // 周波数変換はまだないので直接出力バッファに書く。 ! 396: if (1) { ! 397: dst = outbuf.get() + out_samples_per_blk * outpos; ! 398: dstbytes = SAMPLES_TO_BYTES(out_samples_per_blk); ! 399: } ! 400: ! 401: // ソースを合成。 ! 402: bool first = true; ! 403: bool play = false; ! 404: for (auto& track : tracks) { ! 405: if (track.status == Stopped) { ! 406: continue; ! 407: } ! 408: if (track.status == Drained) { ! 409: // トラックが前回のブロックで終了したのでレベルメータを下げる。 ! 410: // 時間軸が無限に流れていれば不要な処理だが、現在の実装だと ! 411: // 再生ブロックが終了すると自然とループ自体が止まる仕組みで、 ! 412: // 再生ループが止まると最後のブロックのピークレベルから ! 413: // 書き換わらないことになってしまうので、ここで再生終了後の ! 414: // 次の無音ブロックを表現している。 ! 415: ClearDBFS(track.dbfs); ! 416: track.status = Stopped; ! 417: continue; ! 418: } ! 419: play = true; ! 420: ! 421: // このブロック時刻に対応するバッファがあるか。 ! 422: int16 *src = track.GetBlockBySeq(vseq); ! 423: if (src) { ! 424: // デバイスごと生波形についての処理。 ! 425: ! 426: // レベルを計算。 ! 427: CalcDBFS(track.dbfs, src); ! 428: ! 429: // 合成。 ! 430: if (first) { ! 431: memcpy(dst, src, dstbytes); ! 432: first = false; ! 433: } else { ! 434: AddPCM(dst, src); ! 435: } ! 436: ! 437: // デバイスバッファをクリア。 ! 438: // 排他制御はしていないので一周以上遅れると死ぬ ! 439: // (がその状況ではどのみち死ぬのでもう一緒)。 ! 440: track.ClearSeq(vseq); ! 441: } ! 442: ! 443: // Draining なら最後のブロックを処理したので Drained に移行。 ! 444: // 対応バッファがなくてももう出来ることはないので停止。 ! 445: if (__predict_false(track.status == Draining)) { ! 446: // 表示上はここで停止でいいか。 ! 447: putlog(1, "Stopped [%s]", track.GetName().c_str()); ! 448: track.status = Drained; ! 449: } ! 450: } ! 451: ! 452: if (__predict_false(first)) { ! 453: memset(dst, 0, dstbytes); ! 454: } ! 455: ! 456: // マスターレベルを計算。 ! 457: // ここまでは Drained のトラックがいても行う。 ! 458: // 再生が終わった次のブロックでメータをゼロにするため。 ! 459: CalcDBFS(master_dbfs, dst); ! 460: ! 461: // 1トラック以上が Playing ならホストに出力。 ! 462: if (play) { ! 463: hostsnd->Play(dst); ! 464: outpos = (outpos + 1) % NOUTBLKS; ! 465: } ! 466: } ! 467: ! 468: // 1ブロックの PCM の合成を行う。dst = dst + src; ! 469: // PCM データはスケールが 1/MAX_SOUND_SOURCES 倍してあるため、 ! 470: // 16ビットのまま加算しても溢れない。 ! 471: void ! 472: SoundRenderer::AddPCM(int16 *d, const int16 *s) ! 473: { ! 474: for (uint i = 0; i < mixer_samples_per_blk; i++) { ! 475: *d = *d + *s; ! 476: d++; ! 477: s++; ! 478: } ! 479: } ! 480: ! 481: // 出力バッファ 1ブロックのバイト数を返す。 ! 482: uint ! 483: SoundRenderer::GetOutBytesPerBlk() const noexcept ! 484: { ! 485: return SAMPLES_TO_BYTES(out_samples_per_blk); ! 486: } ! 487: ! 488: // src 1ブロックからチャンネルごとの dbFS を求めて dbfs に書き戻す。 ! 489: void ! 490: SoundRenderer::CalcDBFS(std::array<double, NCHAN>& dbfs, const int16 *src) ! 491: { ! 492: // RMS とピークとあるが、ここではピークを表示する。 ! 493: ! 494: std::array<int32, NCHAN> ipeak {}; ! 495: for (const int16 *end = src + mixer_samples_per_blk; src < end; ) { ! 496: for (uint j = 0; j < NCHAN; j++) { ! 497: int16 s = *src++; ! 498: ipeak[j] = std::max(ipeak[j], (int32)std::abs(s)); ! 499: } ! 500: } ! 501: ! 502: for (uint j = 0; j < NCHAN; j++) { ! 503: // std::log10(0) の結果は「処理系定義」なので避ける。 ! 504: dbfs[j] = (ipeak[j] == 0) ! 505: ? -INFINITY ! 506: : 20.0 * std::log10((double)ipeak[j] / 32768); ! 507: } ! 508: } ! 509: ! 510: // この dbfs をクリアする。 ! 511: /*static*/ void ! 512: SoundRenderer::ClearDBFS(std::array<double, NCHAN>& dbfs) ! 513: { ! 514: std::fill(dbfs.begin(), dbfs.end(), -INFINITY); ! 515: } ! 516: ! 517: void ! 518: SoundRenderer::MonitorUpdate(Monitor *, TextScreen& screen) ! 519: { ! 520: int y; ! 521: ! 522: screen.Clear(); ! 523: ! 524: // 0123456789012345678901234567890123456789 ! 525: // Master L:01234567890123456789 ! 526: // R:GGGGGGGGGGGGGOOOOORR ! 527: // ! 528: // [ADPCM] Running L: ! 529: ! 530: static const char * const statstr[] = { ! 531: "Stopped", ! 532: "Drained", ! 533: "Running", ! 534: "Draining", ! 535: }; ! 536: ! 537: y = 0; ! 538: screen.Print(0, y, "Master"); ! 539: MonitorUpdateLevelMeter(screen, 18, y, master_dbfs); ! 540: y += NCHAN; ! 541: ! 542: std::string hline(screen.GetCol(), '-'); ! 543: screen.Puts(0, y++, TA::Disable, hline.c_str()); ! 544: ! 545: for (const auto& track : tracks) { ! 546: screen.Print(0, y, "%s", track.GetName().c_str()); ! 547: screen.Print(6, y, "[%s]", statstr[track.status]); ! 548: MonitorUpdateLevelMeter(screen, 18, y, track.dbfs); ! 549: y += (NCHAN + 1); ! 550: } ! 551: } ! 552: ! 553: void ! 554: SoundRenderer::MonitorUpdateLevelMeter(TextScreen& screen, ! 555: int x, int y, const std::array<double, NCHAN> dbfs) ! 556: { ! 557: const int METER_LEN = 20; // メータ部分の文字数 ! 558: const int METER_DIV = 3; // 1文字あたりの dbFS ! 559: ! 560: screen.Puts(x, y + 0, "L:"); ! 561: screen.Puts(x, y + 1, "R:"); ! 562: x += 2; ! 563: ! 564: for (uint ch = 0; ch < NCHAN; ch++) { ! 565: // 下地。 ! 566: uint16 bg = ' ' | TA::Off; ! 567: for (uint i = 0; i < METER_LEN; i++) { ! 568: screen.Putc(x + i, y + ch, bg); ! 569: } ! 570: ! 571: // 最小の振幅は -90.3dbFS なので、これ以下は無音。 ! 572: if (dbfs[ch] < -91) { ! 573: continue; ! 574: } ! 575: // プラス方向に切り上げて丸める。 ! 576: int idbfs = (int)std::ceil(dbfs[ch]); ! 577: // -60dbFS 付近以下は1レベルにまとめる。 ! 578: int width = METER_LEN + idbfs / METER_DIV; ! 579: if (width < 1) { ! 580: width = 1; ! 581: } ! 582: ! 583: uint16 fg = ' ' | TA::ReverseGreen; ! 584: for (uint i = 0; i < width; i++) { ! 585: // -20dbFS 以上は黄色(オレンジ)、-6dbFS 以上は赤。 ! 586: if (i == (METER_LEN - (20 / METER_DIV))) { ! 587: fg = ' ' | TA::ReverseOrange; ! 588: } else if (i == (METER_LEN - (6 / METER_DIV))) { ! 589: fg = ' ' | TA::ReverseRed; ! 590: } ! 591: screen.Putc(x + i, y + ch, fg); ! 592: } ! 593: } ! 594: }
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.