|
@@ -1621,9 +1621,8 @@ static int
|
|
|
netxen_nic_pci_mem_write_2M(struct netxen_adapter *adapter,
|
|
|
u64 off, u64 data)
|
|
|
{
|
|
|
- int i, j, ret;
|
|
|
+ int j, ret;
|
|
|
u32 temp, off8;
|
|
|
- u64 stride;
|
|
|
void __iomem *mem_crb;
|
|
|
|
|
|
/* Only 64-bit aligned access */
|
|
@@ -1650,44 +1649,17 @@ netxen_nic_pci_mem_write_2M(struct netxen_adapter *adapter,
|
|
|
return -EIO;
|
|
|
|
|
|
correct:
|
|
|
- stride = NX_IS_REVISION_P3P(adapter->ahw.revision_id) ? 16 : 8;
|
|
|
-
|
|
|
- off8 = off & ~(stride-1);
|
|
|
+ off8 = off & 0xfffffff8;
|
|
|
|
|
|
spin_lock(&adapter->ahw.mem_lock);
|
|
|
|
|
|
writel(off8, (mem_crb + MIU_TEST_AGT_ADDR_LO));
|
|
|
writel(0, (mem_crb + MIU_TEST_AGT_ADDR_HI));
|
|
|
|
|
|
- i = 0;
|
|
|
- if (stride == 16) {
|
|
|
- writel(TA_CTL_ENABLE, (mem_crb + TEST_AGT_CTRL));
|
|
|
- writel((TA_CTL_START | TA_CTL_ENABLE),
|
|
|
- (mem_crb + TEST_AGT_CTRL));
|
|
|
-
|
|
|
- for (j = 0; j < MAX_CTL_CHECK; j++) {
|
|
|
- temp = readl(mem_crb + TEST_AGT_CTRL);
|
|
|
- if ((temp & TA_CTL_BUSY) == 0)
|
|
|
- break;
|
|
|
- }
|
|
|
-
|
|
|
- if (j >= MAX_CTL_CHECK) {
|
|
|
- ret = -EIO;
|
|
|
- goto done;
|
|
|
- }
|
|
|
-
|
|
|
- i = (off & 0xf) ? 0 : 2;
|
|
|
- writel(readl(mem_crb + MIU_TEST_AGT_RDDATA(i)),
|
|
|
- mem_crb + MIU_TEST_AGT_WRDATA(i));
|
|
|
- writel(readl(mem_crb + MIU_TEST_AGT_RDDATA(i+1)),
|
|
|
- mem_crb + MIU_TEST_AGT_WRDATA(i+1));
|
|
|
- i = (off & 0xf) ? 2 : 0;
|
|
|
- }
|
|
|
-
|
|
|
writel(data & 0xffffffff,
|
|
|
- mem_crb + MIU_TEST_AGT_WRDATA(i));
|
|
|
+ mem_crb + MIU_TEST_AGT_WRDATA_LO);
|
|
|
writel((data >> 32) & 0xffffffff,
|
|
|
- mem_crb + MIU_TEST_AGT_WRDATA(i+1));
|
|
|
+ mem_crb + MIU_TEST_AGT_WRDATA_HI);
|
|
|
|
|
|
writel((TA_CTL_ENABLE | TA_CTL_WRITE), (mem_crb + TEST_AGT_CTRL));
|
|
|
writel((TA_CTL_START | TA_CTL_ENABLE | TA_CTL_WRITE),
|
|
@@ -1707,7 +1679,6 @@ correct:
|
|
|
} else
|
|
|
ret = 0;
|
|
|
|
|
|
-done:
|
|
|
spin_unlock(&adapter->ahw.mem_lock);
|
|
|
|
|
|
return ret;
|
|
@@ -1719,7 +1690,7 @@ netxen_nic_pci_mem_read_2M(struct netxen_adapter *adapter,
|
|
|
{
|
|
|
int j, ret;
|
|
|
u32 temp, off8;
|
|
|
- u64 val, stride;
|
|
|
+ u64 val;
|
|
|
void __iomem *mem_crb;
|
|
|
|
|
|
/* Only 64-bit aligned access */
|
|
@@ -1748,9 +1719,7 @@ netxen_nic_pci_mem_read_2M(struct netxen_adapter *adapter,
|
|
|
return -EIO;
|
|
|
|
|
|
correct:
|
|
|
- stride = NX_IS_REVISION_P3P(adapter->ahw.revision_id) ? 16 : 8;
|
|
|
-
|
|
|
- off8 = off & ~(stride-1);
|
|
|
+ off8 = off & 0xfffffff8;
|
|
|
|
|
|
spin_lock(&adapter->ahw.mem_lock);
|
|
|
|
|
@@ -1771,13 +1740,8 @@ correct:
|
|
|
"failed to read through agent\n");
|
|
|
ret = -EIO;
|
|
|
} else {
|
|
|
- off8 = MIU_TEST_AGT_RDDATA_LO;
|
|
|
- if ((stride == 16) && (off & 0xf))
|
|
|
- off8 = MIU_TEST_AGT_RDDATA_UPPER_LO;
|
|
|
-
|
|
|
- temp = readl(mem_crb + off8 + 4);
|
|
|
- val = (u64)temp << 32;
|
|
|
- val |= readl(mem_crb + off8);
|
|
|
+ val = (u64)(readl(mem_crb + MIU_TEST_AGT_RDDATA_HI)) << 32;
|
|
|
+ val |= readl(mem_crb + MIU_TEST_AGT_RDDATA_LO);
|
|
|
*data = val;
|
|
|
ret = 0;
|
|
|
}
|