--- nono/vm/virtio_block.cpp 2026/04/29 17:05:32 1.1.1.3 +++ nono/vm/virtio_block.cpp 2026/04/29 17:05:42 1.1.1.4 @@ -195,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", @@ -210,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; } @@ -239,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; } @@ -277,37 +255,13 @@ VirtIOBlockDevice::CmdRead(VirtIOReq& re uint32 VirtIOBlockDevice::CmdWrite(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); - - 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(); - - 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;