📄 mv64x60.c
字号:
enables = in_le32((u32 *)(bridge_base + MV64x60_CPU_BAR_ENABLE)) & 0xf; for (i=0; i<MV64x60_CPU2MEM_WINDOWS; i++) { if (enables & (1 << i)) /* Set means disabled */ continue; base = in_le32((u32 *)(bridge_base + mv64x60_cpu2mem[i].lo)) << 16; base |= snoop_bits | (mv64x60_dram_selects[i] << 8); size = in_le32((u32 *)(bridge_base + mv64x60_cpu2mem[i].size)) << 16; prot |= (0x3 << (i << 1)); /* RW access */ out_le32((u32 *)(bridge_base + mv64x60_enet2mem[i].lo), base); out_le32((u32 *)(bridge_base + mv64x60_enet2mem[i].size), size); out_le32((u32 *)(bridge_base + mv64x60_mpsc2mem[i].lo), base); out_le32((u32 *)(bridge_base + mv64x60_mpsc2mem[i].size), size); out_le32((u32 *)(bridge_base + mv64x60_idma2mem[i].lo), base); out_le32((u32 *)(bridge_base + mv64x60_idma2mem[i].size), size); } out_le32((u32 *)(bridge_base + MV64x60_ENET2MEM_ACC_PROT_0), prot); out_le32((u32 *)(bridge_base + MV64x60_ENET2MEM_ACC_PROT_1), prot); out_le32((u32 *)(bridge_base + MV64x60_ENET2MEM_ACC_PROT_2), prot); out_le32((u32 *)(bridge_base + MV64x60_MPSC2MEM_ACC_PROT_0), prot); out_le32((u32 *)(bridge_base + MV64x60_MPSC2MEM_ACC_PROT_1), prot); out_le32((u32 *)(bridge_base + MV64x60_IDMA2MEM_ACC_PROT_0), prot); out_le32((u32 *)(bridge_base + MV64x60_IDMA2MEM_ACC_PROT_1), prot); out_le32((u32 *)(bridge_base + MV64x60_IDMA2MEM_ACC_PROT_2), prot); out_le32((u32 *)(bridge_base + MV64x60_IDMA2MEM_ACC_PROT_3), prot); /* Set mpsc->bridge's reg window to the bridge's internal registers. */ out_le32((u32 *)(bridge_base + MV64x60_MPSC2REGS_BASE), (u32)bridge_pbase); out_le32((u32 *)(bridge_base + MV64x60_ENET2MEM_BAR_ENABLE), enables); out_le32((u32 *)(bridge_base + MV64x60_MPSC2MEM_BAR_ENABLE), enables); out_le32((u32 *)(bridge_base + MV64x60_IDMA2MEM_BAR_ENABLE), enables);}/* PCI MEM -> system memory, et. al. setup */static struct mv64x60_pci_win mv64x60_pci2mem[2] = { { /* hose 0 */ .fcn = 0, .hi = 0x14, .lo = 0x10, .size = MV64x60_PCI02MEM_0_SIZE, }, { /* hose 1 */ .fcn = 0, .hi = 0x94, .lo = 0x90, .size = MV64x60_PCI12MEM_0_SIZE, },};static structmv64x60_mem_win mv64x60_pci_acc[2][MV64x60_PCI_ACC_CNTL_WINDOWS] = { { /* hose 0 */ { .hi = MV64x60_PCI0_ACC_CNTL_0_BASE_HI, .lo = MV64x60_PCI0_ACC_CNTL_0_BASE_LO, .size = MV64x60_PCI0_ACC_CNTL_0_SIZE, }, { .hi = MV64x60_PCI0_ACC_CNTL_1_BASE_HI, .lo = MV64x60_PCI0_ACC_CNTL_1_BASE_LO, .size = MV64x60_PCI0_ACC_CNTL_1_SIZE, }, { .hi = MV64x60_PCI0_ACC_CNTL_2_BASE_HI, .lo = MV64x60_PCI0_ACC_CNTL_2_BASE_LO, .size = MV64x60_PCI0_ACC_CNTL_2_SIZE, }, { .hi = MV64x60_PCI0_ACC_CNTL_3_BASE_HI, .lo = MV64x60_PCI0_ACC_CNTL_3_BASE_LO, .size = MV64x60_PCI0_ACC_CNTL_3_SIZE, }, }, { /* hose 1 */ { .hi = MV64x60_PCI1_ACC_CNTL_0_BASE_HI, .lo = MV64x60_PCI1_ACC_CNTL_0_BASE_LO, .size = MV64x60_PCI1_ACC_CNTL_0_SIZE, }, { .hi = MV64x60_PCI1_ACC_CNTL_1_BASE_HI, .lo = MV64x60_PCI1_ACC_CNTL_1_BASE_LO, .size = MV64x60_PCI1_ACC_CNTL_1_SIZE, }, { .hi = MV64x60_PCI1_ACC_CNTL_2_BASE_HI, .lo = MV64x60_PCI1_ACC_CNTL_2_BASE_LO, .size = MV64x60_PCI1_ACC_CNTL_2_SIZE, }, { .hi = MV64x60_PCI1_ACC_CNTL_3_BASE_HI, .lo = MV64x60_PCI1_ACC_CNTL_3_BASE_LO, .size = MV64x60_PCI1_ACC_CNTL_3_SIZE, }, },};static struct mv64x60_mem_win mv64x60_pci2reg[2] = { { .hi = 0x24, .lo = 0x20, .size = 0, }, { .hi = 0xa4, .lo = 0xa0, .size = 0, },};/* Only need to use 1 window (per hose) to get access to all of system memory */void mv64x60_config_pci_windows(u8 *bridge_base, u8 *bridge_pbase, u8 hose, u8 bus, u32 mem_size, u32 acc_bits){ u32 i, offset, bar_enable, enables; /* Disable all windows but PCI MEM -> Bridge's regs window */ enables = ~(1 << 9); bar_enable = hose ? MV64x60_PCI1_BAR_ENABLE : MV64x60_PCI0_BAR_ENABLE; out_le32((u32 *)(bridge_base + bar_enable), enables); for (i=0; i<MV64x60_PCI_ACC_CNTL_WINDOWS; i++) out_le32((u32 *)(bridge_base + mv64x60_pci_acc[hose][i].lo), 0); /* If mem_size is 0, leave windows disabled */ if (mem_size == 0) return; /* Cause automatic updates of PCI remap regs */ offset = hose ? MV64x60_PCI1_PCI_DECODE_CNTL : MV64x60_PCI0_PCI_DECODE_CNTL; i = in_le32((u32 *)(bridge_base + offset)); out_le32((u32 *)(bridge_base + offset), i & ~0x1); mem_size = (mem_size - 1) & 0xfffff000; /* Map PCI MEM addr 0 -> System Mem addr 0 */ mv64x60_cfg_write(bridge_base, hose, bus, PCI_DEVFN(0, mv64x60_pci2mem[hose].fcn), mv64x60_pci2mem[hose].hi, 0); mv64x60_cfg_write(bridge_base, hose, bus, PCI_DEVFN(0, mv64x60_pci2mem[hose].fcn), mv64x60_pci2mem[hose].lo, 0); out_le32((u32 *)(bridge_base + mv64x60_pci2mem[hose].size),mem_size); acc_bits |= MV64x60_PCI_ACC_CNTL_ENABLE; out_le32((u32 *)(bridge_base + mv64x60_pci_acc[hose][0].hi), 0); out_le32((u32 *)(bridge_base + mv64x60_pci_acc[hose][0].lo), acc_bits); out_le32((u32 *)(bridge_base + mv64x60_pci_acc[hose][0].size),mem_size); /* Set PCI MEM->bridge's reg window to where they are in CPU mem map */ i = (u32)bridge_base; i &= 0xffff0000; i |= (0x2 << 1); mv64x60_cfg_write(bridge_base, hose, bus, PCI_DEVFN(0,0), mv64x60_pci2reg[hose].hi, 0); mv64x60_cfg_write(bridge_base, hose, bus, PCI_DEVFN(0,0), mv64x60_pci2reg[hose].lo, i); enables &= ~0x1; /* Enable PCI MEM -> System Mem window 0 */ out_le32((u32 *)(bridge_base + bar_enable), enables);}/* CPU -> PCI I/O & MEM setup */struct mv64x60_cpu2pci_win mv64x60_cpu2pci_io[2] = { { /* hose 0 */ .lo = MV64x60_CPU2PCI0_IO_BASE, .size = MV64x60_CPU2PCI0_IO_SIZE, .remap_hi = 0, .remap_lo = MV64x60_CPU2PCI0_IO_REMAP, }, { /* hose 1 */ .lo = MV64x60_CPU2PCI1_IO_BASE, .size = MV64x60_CPU2PCI1_IO_SIZE, .remap_hi = 0, .remap_lo = MV64x60_CPU2PCI1_IO_REMAP, },};struct mv64x60_cpu2pci_win mv64x60_cpu2pci_mem[2] = { { /* hose 0 */ .lo = MV64x60_CPU2PCI0_MEM_0_BASE, .size = MV64x60_CPU2PCI0_MEM_0_SIZE, .remap_hi = MV64x60_CPU2PCI0_MEM_0_REMAP_HI, .remap_lo = MV64x60_CPU2PCI0_MEM_0_REMAP_LO, }, { /* hose 1 */ .lo = MV64x60_CPU2PCI1_MEM_0_BASE, .size = MV64x60_CPU2PCI1_MEM_0_SIZE, .remap_hi = MV64x60_CPU2PCI1_MEM_0_REMAP_HI, .remap_lo = MV64x60_CPU2PCI1_MEM_0_REMAP_LO, },};/* Only need to set up 1 window to pci mem space */void mv64x60_config_cpu2pci_window(u8 *bridge_base, u8 hose, u32 pci_base_hi, u32 pci_base_lo, u32 cpu_base, u32 size, struct mv64x60_cpu2pci_win *offset_tbl){ cpu_base >>= 16; cpu_base |= MV64x60_CPU2PCI_SWAP_NONE; out_le32((u32 *)(bridge_base + offset_tbl[hose].lo), cpu_base); if (offset_tbl[hose].remap_hi != 0) out_le32((u32 *)(bridge_base + offset_tbl[hose].remap_hi), pci_base_hi); out_le32((u32 *)(bridge_base + offset_tbl[hose].remap_lo), pci_base_lo >> 16); size = (size - 1) >> 16; out_le32((u32 *)(bridge_base + offset_tbl[hose].size), size);}/* Read mem ctlr to get the amount of mem in system */u32 mv64x60_get_mem_size(u8 *bridge_base){ u32 enables, i, v; u32 mem = 0; enables = in_le32((u32 *)(bridge_base + MV64x60_CPU_BAR_ENABLE)) & 0xf; for (i=0; i<MV64x60_CPU2MEM_WINDOWS; i++) if (!(enables & (1<<i))) { v = in_le32((u32*)(bridge_base + mv64x60_cpu2mem[i].size)); v = ((v & 0xffff) + 1) << 16; mem += v; } return mem;}/* Get physical address of bridge's registers */u8 *mv64x60_get_bridge_pbase(void){ u32 v[2]; void *devp; devp = finddevice("/mv64x60"); if (devp == NULL) goto err_out; if (getprop(devp, "reg", v, sizeof(v)) != sizeof(v)) goto err_out; return (u8 *)v[0];err_out: return 0;}/* Get virtual address of bridge's registers */u8 *mv64x60_get_bridge_base(void){ u32 v; void *devp; devp = finddevice("/mv64x60"); if (devp == NULL) goto err_out; if (getprop(devp, "virtual-reg", &v, sizeof(v)) != sizeof(v)) goto err_out; return (u8 *)v;err_out: return 0;}u8 mv64x60_is_coherent(void){ u32 v; void *devp; devp = finddevice("/"); if (devp == NULL) return 1; /* Assume coherency on */ if (getprop(devp, "coherency-off", &v, sizeof(v)) < 0) return 1; /* Coherency on */ else return 0;}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -