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

RP06: can now load bootloader

Browse source
This commit is contained in:
Folkert van Heusden 2024-06-12 23:43:14 +02:00
parent 1599eef46b
commit c4db1d7f38
Signed by untrusted user who does not match committer: folkert
GPG key ID: 30190E8C1F28D8AE
1 changed files with 12 additions and 5 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

17
rp06.cpp
View file

@ -71,8 +71,7 @@ uint8_t rp06::read_byte(const uint16_t addr)
uint16_t rp06::read_word(const uint16_t addr) uint16_t rp06::read_word(const uint16_t addr)
{ {
const int reg = (addr - RP06_BASE) / 2; const int reg = reg_num(addr);
uint16_t value = 0; uint16_t value = 0;
@ -150,9 +149,9 @@ void rp06::write_word(const uint16_t addr, uint16_t v)
registers[reg] = v; registers[reg] = v;
if (reg == RP06_CS1) { if (addr == RP06_CS1) {
if (v & 1) { if (v & 1) {
int function_code = v & 63; int function_code = v & 62;
if (function_code == 070) { // READ if (function_code == 070) { // READ
uint32_t offs = compute_offset(); uint32_t offs = compute_offset();
@ -161,9 +160,11 @@ void rp06::write_word(const uint16_t addr, uint16_t v)
uint32_t nw = 65536 - registers[reg_num(RP06_WC)]; uint32_t nw = 65536 - registers[reg_num(RP06_WC)];
uint32_t nb = nw * 2; uint32_t nb = nw * 2;
DOLOG(debug, false, "RP06: reading %u bytes from %u (dec) to %06o (oct)\n", nw, offs, addr);
uint8_t xfer_buffer[SECTOR_SIZE] { }; uint8_t xfer_buffer[SECTOR_SIZE] { };
for(uint32_t cur_offset = offs; cur_offset<offs + nb; cur_offset += 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)) { if (!fhs.at(0)->read(cur_offset, SECTOR_SIZE, xfer_buffer, SECTOR_SIZE)) {
DOLOG(ll_error, true, "RP06 read error %s from %u", strerror(errno), cur_offset); 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_ERROR - RK05_BASE) / 2] |= 32; // non existing sector
//registers[(RK05_CS - RK05_BASE) / 2] |= 3 << 14; // an error occured //registers[(RK05_CS - RK05_BASE) / 2] |= 3 << 14; // an error occured
@ -180,6 +181,12 @@ void rp06::write_word(const uint16_t addr, uint16_t v)
if (registers[reg_num(RP06_CS1)] & 0100) // IE? (interrupt enable) if (registers[reg_num(RP06_CS1)] & 0100) // IE? (interrupt enable)
b->getCpu()->queue_interrupt(5, 0254); b->getCpu()->queue_interrupt(5, 0254);
} }
else {
DOLOG(debug, false, "RP06: command %03o not implemented\n", function_code);
}
} }
} }
else {
DOLOG(debug, false, "RP06: write ignored to %06o\n", addr);
}
} }