1
2
3
4
5
6
7
8
9
10
11#include <linux/types.h>
12#include <linux/init.h>
13#include <linux/ioport.h>
14#include <linux/device.h>
15#include <linux/platform_device.h>
16#include <linux/mv643xx.h>
17#include <linux/pci.h>
18
19#define PEGASOS2_MARVELL_REGBASE (0xf1000000)
20#define PEGASOS2_MARVELL_REGSIZE (0x00004000)
21#define PEGASOS2_SRAM_BASE (0xf2000000)
22#define PEGASOS2_SRAM_SIZE (256*1024)
23
24#define PEGASOS2_SRAM_BASE_ETH_PORT0 (PEGASOS2_SRAM_BASE)
25#define PEGASOS2_SRAM_BASE_ETH_PORT1 (PEGASOS2_SRAM_BASE_ETH_PORT0 + (PEGASOS2_SRAM_SIZE / 2) )
26
27
28#define PEGASOS2_SRAM_RXRING_SIZE (PEGASOS2_SRAM_SIZE/4)
29#define PEGASOS2_SRAM_TXRING_SIZE (PEGASOS2_SRAM_SIZE/4)
30
31#undef BE_VERBOSE
32
33static struct resource mv643xx_eth_shared_resources[] = {
34 [0] = {
35 .name = "ethernet shared base",
36 .start = 0xf1000000 + MV643XX_ETH_SHARED_REGS,
37 .end = 0xf1000000 + MV643XX_ETH_SHARED_REGS +
38 MV643XX_ETH_SHARED_REGS_SIZE - 1,
39 .flags = IORESOURCE_MEM,
40 },
41};
42
43static struct platform_device mv643xx_eth_shared_device = {
44 .name = MV643XX_ETH_SHARED_NAME,
45 .id = 0,
46 .num_resources = ARRAY_SIZE(mv643xx_eth_shared_resources),
47 .resource = mv643xx_eth_shared_resources,
48};
49
50static struct resource mv643xx_eth_port1_resources[] = {
51 [0] = {
52 .name = "eth port1 irq",
53 .start = 9,
54 .end = 9,
55 .flags = IORESOURCE_IRQ,
56 },
57};
58
59static struct mv643xx_eth_platform_data eth_port1_pd = {
60 .shared = &mv643xx_eth_shared_device,
61 .port_number = 1,
62 .phy_addr = MV643XX_ETH_PHY_ADDR(7),
63
64 .tx_sram_addr = PEGASOS2_SRAM_BASE_ETH_PORT1,
65 .tx_sram_size = PEGASOS2_SRAM_TXRING_SIZE,
66 .tx_queue_size = PEGASOS2_SRAM_TXRING_SIZE/16,
67
68 .rx_sram_addr = PEGASOS2_SRAM_BASE_ETH_PORT1 + PEGASOS2_SRAM_TXRING_SIZE,
69 .rx_sram_size = PEGASOS2_SRAM_RXRING_SIZE,
70 .rx_queue_size = PEGASOS2_SRAM_RXRING_SIZE/16,
71};
72
73static struct platform_device eth_port1_device = {
74 .name = MV643XX_ETH_NAME,
75 .id = 1,
76 .num_resources = ARRAY_SIZE(mv643xx_eth_port1_resources),
77 .resource = mv643xx_eth_port1_resources,
78 .dev = {
79 .platform_data = ð_port1_pd,
80 },
81};
82
83static struct platform_device *mv643xx_eth_pd_devs[] __initdata = {
84 &mv643xx_eth_shared_device,
85 ð_port1_device,
86};
87
88
89
90#define MV_READ(offset,val) { val = readl(mv643xx_reg_base + offset); }
91#define MV_WRITE(offset,data) writel(data, mv643xx_reg_base + offset)
92
93static void __iomem *mv643xx_reg_base;
94
95static int Enable_SRAM(void)
96{
97 u32 ALong;
98
99 if (mv643xx_reg_base == NULL)
100 mv643xx_reg_base = ioremap(PEGASOS2_MARVELL_REGBASE,
101 PEGASOS2_MARVELL_REGSIZE);
102
103 if (mv643xx_reg_base == NULL)
104 return -ENOMEM;
105
106#ifdef BE_VERBOSE
107 printk("Pegasos II/Marvell MV64361: register remapped from %p to %p\n",
108 (void *)PEGASOS2_MARVELL_REGBASE, (void *)mv643xx_reg_base);
109#endif
110
111 MV_WRITE(MV64340_SRAM_CONFIG, 0);
112
113 MV_WRITE(MV64340_INTEGRATED_SRAM_BASE_ADDR, PEGASOS2_SRAM_BASE >> 16);
114
115 MV_READ(MV64340_BASE_ADDR_ENABLE, ALong);
116 ALong &= ~(1 << 19);
117 MV_WRITE(MV64340_BASE_ADDR_ENABLE, ALong);
118
119 ALong = 0x02;
120 ALong |= PEGASOS2_SRAM_BASE & 0xffff0000;
121 MV_WRITE(MV643XX_ETH_BAR_4, ALong);
122
123 MV_WRITE(MV643XX_ETH_SIZE_REG_4, (PEGASOS2_SRAM_SIZE-1) & 0xffff0000);
124
125 MV_READ(MV643XX_ETH_BASE_ADDR_ENABLE_REG, ALong);
126 ALong &= ~(1 << 4);
127 MV_WRITE(MV643XX_ETH_BASE_ADDR_ENABLE_REG, ALong);
128
129#ifdef BE_VERBOSE
130 printk("Pegasos II/Marvell MV64361: register unmapped\n");
131 printk("Pegasos II/Marvell MV64361: SRAM at %p, size=%x\n", (void*) PEGASOS2_SRAM_BASE, PEGASOS2_SRAM_SIZE);
132#endif
133
134 iounmap(mv643xx_reg_base);
135 mv643xx_reg_base = NULL;
136
137 return 1;
138}
139
140
141
142
143static int __init mv643xx_eth_add_pds(void)
144{
145 int ret = 0;
146 static struct pci_device_id pci_marvell_mv64360[] = {
147 { PCI_DEVICE(PCI_VENDOR_ID_MARVELL, PCI_DEVICE_ID_MARVELL_MV64360) },
148 { }
149 };
150
151#ifdef BE_VERBOSE
152 printk("Pegasos II/Marvell MV64361: init\n");
153#endif
154
155 if (pci_dev_present(pci_marvell_mv64360)) {
156 ret = platform_add_devices(mv643xx_eth_pd_devs,
157 ARRAY_SIZE(mv643xx_eth_pd_devs));
158
159 if ( Enable_SRAM() < 0)
160 {
161 eth_port1_pd.tx_sram_addr = 0;
162 eth_port1_pd.tx_sram_size = 0;
163 eth_port1_pd.rx_sram_addr = 0;
164 eth_port1_pd.rx_sram_size = 0;
165
166#ifdef BE_VERBOSE
167 printk("Pegasos II/Marvell MV64361: Can't enable the "
168 "SRAM\n");
169#endif
170 }
171 }
172
173#ifdef BE_VERBOSE
174 printk("Pegasos II/Marvell MV64361: init is over\n");
175#endif
176
177 return ret;
178}
179
180device_initcall(mv643xx_eth_add_pds);
181