i82586: fix address hash and multicast setup bugs

This commit is contained in:
Patrick Mackinlay 2021-01-07 18:28:35 +07:00
parent e74bcd7752
commit ded9173f78

View File

@ -582,7 +582,7 @@ u64 i82586_base_device::address_hash(u8 *buf, int length)
// address hash is computed using bits 2-7 from crc of address // address hash is computed using bits 2-7 from crc of address
u32 crc = compute_crc(buf, length, false); u32 crc = compute_crc(buf, length, false);
return 1U << ((crc >> 2) & 0x3f); return u64(1) << ((crc >> 2) & 0x3f);
} }
int i82586_base_device::fetch_bytes(u8 *buf, u32 src, int length) int i82586_base_device::fetch_bytes(u8 *buf, u32 src, int length)
@ -893,35 +893,49 @@ bool i82586_device::cu_configure()
bool i82586_device::cu_mcsetup() bool i82586_device::cu_mcsetup()
{ {
int addr_len = cfg_address_length(); // read the address list length
u16 mc_count; int mc_count = m_space->read_word(m_cba + 6, TB_COUNT);
u8 data[6];
if (addr_len != 6)
{
LOG("cu_mcsetup unexpected address length %d != 6\n", addr_len);
return false;
}
// read the address count
mc_count = m_space->read_word(m_cba + 6, TB_COUNT);
// reset current list // reset current list
LOG("mc_setup configuring %d addresses\n", mc_count);
m_mac_multi = 0; m_mac_multi = 0;
// read and process the addresses if (mc_count < cfg_address_length())
for (int i = 0; i < mc_count; i++)
{ {
*(u16 *)&data[0] = m_space->read_word(m_cba + 8 + i * 6 + 0); LOG("cu_mcsetup multicast filter disabled\n");
*(u16 *)&data[1] = m_space->read_word(m_cba + 8 + i * 6 + 2);
*(u16 *)&data[2] = m_space->read_word(m_cba + 8 + i * 6 + 4); return true;
}
else
LOG("cu_mcsetup configuring %d addresses\n", mc_count / cfg_address_length());
std::vector<u8> buf;
offs_t offset = m_cba + 8;
// read and process the addresses
while (mc_count >= cfg_address_length())
{
// read an address
while (buf.size() < cfg_address_length())
{
u16 const data = m_space->read_word(offset);
buf.push_back(data >> 0);
buf.push_back(data >> 8);
offset += 2;
}
// add a hash of this address to the table // add a hash of this address to the table
m_mac_multi |= address_hash(data, cfg_address_length()); m_mac_multi |= address_hash(buf.data(), cfg_address_length());
LOG("mc_setup inserting address %02x:%02x:%02x:%02x:%02x:%02x\n", if (cfg_address_length() == 6)
data[0], data[1], data[2], data[3], data[4], data[5]); LOG("cu_mcsetup inserting address %02x:%02x:%02x:%02x:%02x:%02x\n",
buf[0], buf[1], buf[2], buf[3], buf[4], buf[5]);
// remove used address bytes from the buffer
buf.erase(buf.begin(), buf.begin() + cfg_address_length());
mc_count -= cfg_address_length();
} }
return true; return true;
@ -1483,68 +1497,65 @@ bool i82596_device::cu_configure()
bool i82596_device::cu_mcsetup() bool i82596_device::cu_mcsetup()
{ {
int addr_len = cfg_address_length(); u32 data = (mode() == MODE_LINEAR) ? m_space->read_dword(m_cba + 8) : m_space->read_word(m_cba + 6);
u16 mc_count = 0; int mc_count = data & TB_COUNT;
int offset = 0; // if length less than one address, clear multicast filter and finish
u8 data[20]; if (mc_count < cfg_address_length())
bool multi_ia;
if (addr_len != 6)
{ {
LOG("cu_mcsetup unexpected address length %d != 6\n", addr_len); LOG("cu_mcsetup multicast filter disabled\n");
return false;
}
switch (mode())
{
case MODE_82586:
case MODE_32SEGMENTED:
mc_count = m_space->read_word(m_cba + 6, TB_COUNT);
break;
case MODE_LINEAR:
mc_count = m_space->read_word(m_cba + 8, TB_COUNT);
offset = 2;
break;
}
// if count is zero, release multicast list and finish
if (mc_count == 0)
{
LOG("mc_setup multicast filter disabled\n");
m_mac_multi = 0; m_mac_multi = 0;
return true; return true;
} }
// fetch the first word std::vector<u8> buf;
*(u32 *)&data[0] = m_space->read_dword(m_cba + 8); offs_t offset = m_cba + 8;
// already have the first two address bytes in linear mode
if (mode() != MODE_LINEAR)
{
data = m_space->read_dword(offset);
buf.push_back(data >> 0);
buf.push_back(data >> 8);
}
buf.push_back(data >> 16);
buf.push_back(data >> 24);
offset += 4;
// multi ia when configured and lsb of first address is clear // multi ia when configured and lsb of first address is clear
multi_ia = cfg_multi_ia() && !BIT(data[offset], 0); bool const multi_ia = cfg_multi_ia() && !BIT(buf[0], 0);
// clear existing list LOG("cu_mcsetup configuring %d %s addresses\n", mc_count / cfg_address_length(), multi_ia ? "multi-ia" : "multicast");
LOG("mc_setup configuring %d %s addresses\n", mc_count, multi_ia ? "multi-ia" : "multicast");
(multi_ia ? m_mac_multi_ia : m_mac_multi) = 0; (multi_ia ? m_mac_multi_ia : m_mac_multi) = 0;
for (int i = 0; i < mc_count; i++) while (mc_count >= cfg_address_length())
{ {
// compute offset of address in 18 byte buffer // read an address
int n = (i % 3) * 6; while (buf.size() < cfg_address_length())
{
data = m_space->read_dword(offset);
// read the next dword buf.push_back(data >> 0);
*(u32 *)&data[n + 6] = m_space->read_dword(m_cba + 8 + i * 4 + 4); buf.push_back(data >> 8);
buf.push_back(data >> 16);
buf.push_back(data >> 24);
// unaligned case needs special handling offset += 4;
if (n == 12 && offset == 2) }
*(u16 *)&data[18] = *(u16 *)&data[0];
// add a hash of this address to the table // add a hash of this address to the table
(multi_ia ? m_mac_multi_ia : m_mac_multi) |= address_hash(&data[n + offset], cfg_address_length()); (multi_ia ? m_mac_multi_ia : m_mac_multi) |= address_hash(buf.data(), cfg_address_length());
LOG("mc_setup inserting address %02x:%02x:%02x:%02x:%02x:%02x\n", if (cfg_address_length() == 6)
data[n + offset + 0], data[n + offset + 1], data[n + offset + 2], data[n + offset + 3], data[n + offset + 4], data[n + offset + 5]); LOG("cu_mcsetup inserting address %02x:%02x:%02x:%02x:%02x:%02x\n",
buf[0], buf[1], buf[2], buf[3], buf[4], buf[5]);
// remove used address bytes from the buffer
buf.erase(buf.begin(), buf.begin() + cfg_address_length());
mc_count -= cfg_address_length();
} }
return true; return true;