folkert/KEK
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions

RP06: read

Browse source
This commit is contained in:
Folkert van Heusden 2024-06-12 18:23:54 +02:00
parent 0490f57bc7
commit 25d34c8b04
Signed by untrusted user who does not match committer: folkert
GPG key ID: 30190E8C1F28D8AE
1 changed files with 21 additions and 1 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

22
rp06.cpp
View file

@ -154,8 +154,28 @@ void rp06::write_word(const uint16_t addr, uint16_t v)
if (v & 1) {
int function_code = v & 63;
if (function_code == 070) {
if (function_code == 060) { // READ
uint32_t offs = compute_offset();
uint32_t addr = getphysaddr();
uint32_t nw = 65536 - registers[reg_num(RP06_WC)];
uint32_t nb = nw * 2;
uint8_t xfer_buffer[SECTOR_SIZE] { };
for(uint32_t cur_offset = offs; cur_offset<offs + nb; cur_offset += SECTOR_SIZE) {
if (!fhs.at(0)->read(offs, SECTOR_SIZE, xfer_buffer, SECTOR_SIZE)) {
DOLOG(ll_error, true, "RP06 read error %s from %u", strerror(errno), cur_offset);
//registers[(RK05_ERROR - RK05_BASE) / 2] |= 32; // non existing sector
//registers[(RK05_CS - RK05_BASE) / 2] |= 3 << 14; // an error occured
break;
}
for(uint32_t i=0; i<SECTOR_SIZE; i++)
b->writeUnibusByte(addr++, xfer_buffer[i]);
}
registers[reg_num(RP06_WC)] = 0;
registers[reg_num(RP06_CS1)] |= 0200; // drive ready
}
}
}