--- nono/vm/virtio_block.cpp 2026/04/29 17:05:28 1.1.1.2 +++ nono/vm/virtio_block.cpp 2026/04/29 17:05:42 1.1.1.4 @@ -13,6 +13,7 @@ #include "config.h" #include "mainram.h" #include "memorystream.h" +#include "monitor.h" // デバイス構成レイアウト class VirtIOBlkConfigWriter @@ -56,7 +57,7 @@ VirtIOBlockDevice::VirtIOBlockDevice(uin device_id = VirtIO::DEVICE_ID_BLOCK; int num_max = 32; - vqueues.emplace_back(0, "RequestQ", num_max); + vqueues.emplace_back(this, 0, "RequestQ", num_max); blocksize = 512; // 割り込み名 @@ -64,9 +65,9 @@ VirtIOBlockDevice::VirtIOBlockDevice(uin // 完了通知メッセージ msgid = MessageID::VIRTIO_BLOCK_DONE(id); - monitor.func = ToMonitorCallback(&VirtIOBlockDevice::MonitorUpdate); - monitor.SetSize(MONITOR_WIDTH, 2 + 4 * 1 + num_max + 3); - monitor.Regist(ID_MONITOR_VIRTIO_BLOCK(id)); + monitor = gMonitorManager->Regist(ID_MONITOR_VIRTIO_BLOCK(id), this); + monitor->func = ToMonitorCallback(&VirtIOBlockDevice::MonitorUpdate); + monitor->SetSize(MONITOR_WIDTH, 2 + 4 * 1 + num_max + 3); } // デストラクタ @@ -194,12 +195,12 @@ VirtIOBlockDevice::ProcessDesc(VirtIOReq // +8.L: 開始セクタ番号 if (ReqReadLE32(req, &type) == false) { - putlog(0, "Cannot read type in header (req.len=$%x)", req.len); + putlog(0, "Cannot read type in header"); return; } ReqReadLE32(req); // skip if (ReqReadLE64(req, §or) == false) { - putlog(0, "Cannot read sector in header (req.len=$%x)", req.len); + putlog(0, "Cannot read sector in header"); return; } putlog(3, "%s req.idx=%u type=%x sec=$%x'%08x", @@ -209,8 +210,8 @@ VirtIOBlockDevice::ProcessDesc(VirtIOReq // ヘッダ(16バイト) とステータスバイト(1バイト) を引いた部分。 // という求め方しかない。 uint32 datalen; - if (req.len >= 16 + 1) { - datalen = req.len - (16 + 1); + if (req.totallen() >= 16 + 1) { + datalen = req.totallen() - (16 + 1); } else { datalen = 0; } @@ -238,37 +239,15 @@ VirtIOBlockDevice::ProcessDesc(VirtIOReq uint32 VirtIOBlockDevice::CmdRead(VirtIOReq& req, uint64 sector, uint32 datalen) { - uint64 imgoffset = sector * 512; + std::vector databuf(datalen); - while (datalen != 0) { - if (req.curseg >= req.buf.size()) { - return VIRTIO_BLK_S_IOERR; - } - const auto seg = req.buf[req.curseg]; - uint32 segoff = req.pos - seg.pos; - std::vector databuf(seg.len - segoff); - - if (image.Read(databuf.data(), imgoffset, databuf.size()) == false) { - return VIRTIO_BLK_S_IOERR; - } - imgoffset += databuf.size(); - - // 指定範囲は通常全域 RAM のはずなので mainram を直接呼ぶ。 - // 指定範囲が RAM からはみ出たりしていたら (通常まずありえない) - // mainbus 経由でアクセスする。 - uint32 addr = seg.addr + segoff; - bool ok = mainram->WriteMem(addr, databuf.data(), databuf.size()); - if (__predict_false(ok == false)) { - for (auto s : databuf) { - WriteU8(addr++, s); - } - } - // 現在位置は必ずセグメント境界のはず。 - req.curseg++; - req.pos += databuf.size(); - - datalen -= databuf.size(); + if (image.Read(databuf.data(), sector * 512, databuf.size()) == false) { + return VIRTIO_BLK_S_IOERR; + } + if (ReqWriteRegion(req, databuf.data(), datalen) != 0) { + return VIRTIO_BLK_S_IOERR; } + return VIRTIO_BLK_S_OK; } @@ -276,37 +255,13 @@ VirtIOBlockDevice::CmdRead(VirtIOReq& re uint32 VirtIOBlockDevice::CmdWrite(VirtIOReq& req, uint64 sector, uint32 datalen) { - uint64 imgoffset = sector * 512; - - while (datalen != 0) { - if (req.curseg >= req.buf.size()) { - return VIRTIO_BLK_S_IOERR; - } - const auto seg = req.buf[req.curseg]; - uint32 segoff = req.pos - seg.pos; - std::vector databuf(seg.len - segoff); - - uint8 *d = &databuf[0]; - uint32 addr = seg.addr + segoff; - // 指定範囲は通常全域 RAM のはずなので mainram を直接呼ぶ。 - // 指定範囲が RAM からはみ出たりしていたら (通常まずありえない) - // mainbus 経由でアクセスする。 - bool ok = mainram->ReadMem(addr, databuf.data(), databuf.size()); - if (__predict_false(ok == false)) { - for (uint32 end = addr + databuf.size(); addr < end; ) { - *d++ = ReadU8(addr++); - } - } - // 現在位置は必ずセグメント境界のはず。 - req.curseg++; - req.pos += databuf.size(); + std::vector databuf(datalen); - if (image.Write(databuf.data(), imgoffset, databuf.size()) == false) { - return VIRTIO_BLK_S_IOERR; - } - imgoffset += databuf.size(); - - datalen -= databuf.size(); + if (ReqReadRegion(req, databuf.data(), datalen) != 0) { + return VIRTIO_BLK_S_IOERR; + } + if (image.Write(databuf.data(), sector * 512, databuf.size()) == false) { + return VIRTIO_BLK_S_IOERR; } return VIRTIO_BLK_S_OK;