2 * Copyright (C) 2005 Sven Luther <sl@bplan-gmbh.de>
4 * Dale Farnsworth <dale@farnsworth.org>
5 * Mark A. Greer <mgreer@mvista.com>
6 * Nicolas DET <nd@bplan-gmbh.de>
7 * Benjamin Herrenschmidt <benh@kernel.crashing.org>
8 * And anyone else who helped me on this.
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>
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)
24 #define PEGASOS2_SRAM_BASE_ETH0 (PEGASOS2_SRAM_BASE)
25 #define PEGASOS2_SRAM_BASE_ETH1 (PEGASOS2_SRAM_BASE_ETH0 + (PEGASOS2_SRAM_SIZE / 2) )
28 #define PEGASOS2_SRAM_RXRING_SIZE (PEGASOS2_SRAM_SIZE/4)
29 #define PEGASOS2_SRAM_TXRING_SIZE (PEGASOS2_SRAM_SIZE/4)
33 static struct resource mv643xx_eth_shared_resources
[] = {
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
,
43 static struct platform_device mv643xx_eth_shared_device
= {
44 .name
= MV643XX_ETH_SHARED_NAME
,
46 .num_resources
= ARRAY_SIZE(mv643xx_eth_shared_resources
),
47 .resource
= mv643xx_eth_shared_resources
,
50 static struct resource mv643xx_eth0_resources
[] = {
55 .flags
= IORESOURCE_IRQ
,
60 static struct mv643xx_eth_platform_data eth0_pd
= {
62 .tx_sram_addr
= PEGASOS2_SRAM_BASE_ETH0
,
63 .tx_sram_size
= PEGASOS2_SRAM_TXRING_SIZE
,
64 .tx_queue_size
= PEGASOS2_SRAM_TXRING_SIZE
/16,
66 .rx_sram_addr
= PEGASOS2_SRAM_BASE_ETH0
+ PEGASOS2_SRAM_TXRING_SIZE
,
67 .rx_sram_size
= PEGASOS2_SRAM_RXRING_SIZE
,
68 .rx_queue_size
= PEGASOS2_SRAM_RXRING_SIZE
/16,
71 static struct platform_device eth0_device
= {
72 .name
= MV643XX_ETH_NAME
,
74 .num_resources
= ARRAY_SIZE(mv643xx_eth0_resources
),
75 .resource
= mv643xx_eth0_resources
,
77 .platform_data
= ð0_pd
,
81 static struct resource mv643xx_eth1_resources
[] = {
86 .flags
= IORESOURCE_IRQ
,
90 static struct mv643xx_eth_platform_data eth1_pd
= {
92 .tx_sram_addr
= PEGASOS2_SRAM_BASE_ETH1
,
93 .tx_sram_size
= PEGASOS2_SRAM_TXRING_SIZE
,
94 .tx_queue_size
= PEGASOS2_SRAM_TXRING_SIZE
/16,
96 .rx_sram_addr
= PEGASOS2_SRAM_BASE_ETH1
+ PEGASOS2_SRAM_TXRING_SIZE
,
97 .rx_sram_size
= PEGASOS2_SRAM_RXRING_SIZE
,
98 .rx_queue_size
= PEGASOS2_SRAM_RXRING_SIZE
/16,
101 static struct platform_device eth1_device
= {
102 .name
= MV643XX_ETH_NAME
,
104 .num_resources
= ARRAY_SIZE(mv643xx_eth1_resources
),
105 .resource
= mv643xx_eth1_resources
,
107 .platform_data
= ð1_pd
,
111 static struct platform_device
*mv643xx_eth_pd_devs
[] __initdata
= {
112 &mv643xx_eth_shared_device
,
119 #define MV_READ(offset,val) { val = readl(mv643xx_reg_base + offset); }
120 #define MV_WRITE(offset,data) writel(data, mv643xx_reg_base + offset)
122 static void __iomem
*mv643xx_reg_base
;
124 static int Enable_SRAM(void)
128 if (mv643xx_reg_base
== NULL
)
129 mv643xx_reg_base
= ioremap(PEGASOS2_MARVELL_REGBASE
,
130 PEGASOS2_MARVELL_REGSIZE
);
132 if (mv643xx_reg_base
== NULL
)
136 printk("Pegasos II/Marvell MV64361: register remapped from %p to %p\n",
137 (void *)PEGASOS2_MARVELL_REGBASE
, (void *)mv643xx_reg_base
);
140 MV_WRITE(MV64340_SRAM_CONFIG
, 0);
142 MV_WRITE(MV64340_INTEGRATED_SRAM_BASE_ADDR
, PEGASOS2_SRAM_BASE
>> 16);
144 MV_READ(MV64340_BASE_ADDR_ENABLE
, ALong
);
146 MV_WRITE(MV64340_BASE_ADDR_ENABLE
, ALong
);
149 ALong
|= PEGASOS2_SRAM_BASE
& 0xffff0000;
150 MV_WRITE(MV643XX_ETH_BAR_4
, ALong
);
152 MV_WRITE(MV643XX_ETH_SIZE_REG_4
, (PEGASOS2_SRAM_SIZE
-1) & 0xffff0000);
154 MV_READ(MV643XX_ETH_BASE_ADDR_ENABLE_REG
, ALong
);
156 MV_WRITE(MV643XX_ETH_BASE_ADDR_ENABLE_REG
, ALong
);
159 printk("Pegasos II/Marvell MV64361: register unmapped\n");
160 printk("Pegasos II/Marvell MV64361: SRAM at %p, size=%x\n", (void*) PEGASOS2_SRAM_BASE
, PEGASOS2_SRAM_SIZE
);
163 iounmap(mv643xx_reg_base
);
164 mv643xx_reg_base
= NULL
;
172 static int __init
mv643xx_eth_add_pds(void)
175 static struct pci_device_id pci_marvell_mv64360
[] = {
176 { PCI_DEVICE(PCI_VENDOR_ID_MARVELL
, PCI_DEVICE_ID_MARVELL_MV64360
) },
181 printk("Pegasos II/Marvell MV64361: init\n");
184 if (pci_dev_present(pci_marvell_mv64360
)) {
185 ret
= platform_add_devices(mv643xx_eth_pd_devs
,
186 ARRAY_SIZE(mv643xx_eth_pd_devs
));
188 if ( Enable_SRAM() < 0)
190 eth0_pd
.tx_sram_addr
= 0;
191 eth0_pd
.tx_sram_size
= 0;
192 eth0_pd
.rx_sram_addr
= 0;
193 eth0_pd
.rx_sram_size
= 0;
195 eth1_pd
.tx_sram_addr
= 0;
196 eth1_pd
.tx_sram_size
= 0;
197 eth1_pd
.rx_sram_addr
= 0;
198 eth1_pd
.rx_sram_size
= 0;
201 printk("Pegasos II/Marvell MV64361: Can't enable the "
208 printk("Pegasos II/Marvell MV64361: init is over\n");
214 device_initcall(mv643xx_eth_add_pds
);