[PATCH] libata: fix ata_qc_issue() error handling
[linux-2.6/suspend2-2.6.18.git] / arch / powerpc / platforms / chrp / pegasos_eth.c
blob29c86781c49365e0ca1e05ecf8fe388f4f7f425c
1 /*
2 * arch/ppc/platforms/chrp_pegasos_eth.c
4 * Copyright (C) 2005 Sven Luther <sl@bplan-gmbh.de>
5 * Thanks to :
6 * Dale Farnsworth <dale@farnsworth.org>
7 * Mark A. Greer <mgreer@mvista.com>
8 * Nicolas DET <nd@bplan-gmbh.de>
9 * Benjamin Herrenschmidt <benh@kernel.crashing.org>
10 * And anyone else who helped me on this.
13 #include <linux/types.h>
14 #include <linux/init.h>
15 #include <linux/ioport.h>
16 #include <linux/device.h>
17 #include <linux/platform_device.h>
18 #include <linux/mv643xx.h>
19 #include <linux/pci.h>
21 #define PEGASOS2_MARVELL_REGBASE (0xf1000000)
22 #define PEGASOS2_MARVELL_REGSIZE (0x00004000)
23 #define PEGASOS2_SRAM_BASE (0xf2000000)
24 #define PEGASOS2_SRAM_SIZE (256*1024)
26 #define PEGASOS2_SRAM_BASE_ETH0 (PEGASOS2_SRAM_BASE)
27 #define PEGASOS2_SRAM_BASE_ETH1 (PEGASOS2_SRAM_BASE_ETH0 + (PEGASOS2_SRAM_SIZE / 2) )
30 #define PEGASOS2_SRAM_RXRING_SIZE (PEGASOS2_SRAM_SIZE/4)
31 #define PEGASOS2_SRAM_TXRING_SIZE (PEGASOS2_SRAM_SIZE/4)
33 #undef BE_VERBOSE
35 static struct resource mv643xx_eth_shared_resources[] = {
36 [0] = {
37 .name = "ethernet shared base",
38 .start = 0xf1000000 + MV643XX_ETH_SHARED_REGS,
39 .end = 0xf1000000 + MV643XX_ETH_SHARED_REGS +
40 MV643XX_ETH_SHARED_REGS_SIZE - 1,
41 .flags = IORESOURCE_MEM,
45 static struct platform_device mv643xx_eth_shared_device = {
46 .name = MV643XX_ETH_SHARED_NAME,
47 .id = 0,
48 .num_resources = ARRAY_SIZE(mv643xx_eth_shared_resources),
49 .resource = mv643xx_eth_shared_resources,
52 static struct resource mv643xx_eth0_resources[] = {
53 [0] = {
54 .name = "eth0 irq",
55 .start = 9,
56 .end = 9,
57 .flags = IORESOURCE_IRQ,
62 static struct mv643xx_eth_platform_data eth0_pd = {
63 .tx_sram_addr = PEGASOS2_SRAM_BASE_ETH0,
64 .tx_sram_size = PEGASOS2_SRAM_TXRING_SIZE,
65 .tx_queue_size = PEGASOS2_SRAM_TXRING_SIZE/16,
67 .rx_sram_addr = PEGASOS2_SRAM_BASE_ETH0 + PEGASOS2_SRAM_TXRING_SIZE,
68 .rx_sram_size = PEGASOS2_SRAM_RXRING_SIZE,
69 .rx_queue_size = PEGASOS2_SRAM_RXRING_SIZE/16,
72 static struct platform_device eth0_device = {
73 .name = MV643XX_ETH_NAME,
74 .id = 0,
75 .num_resources = ARRAY_SIZE(mv643xx_eth0_resources),
76 .resource = mv643xx_eth0_resources,
77 .dev = {
78 .platform_data = &eth0_pd,
82 static struct resource mv643xx_eth1_resources[] = {
83 [0] = {
84 .name = "eth1 irq",
85 .start = 9,
86 .end = 9,
87 .flags = IORESOURCE_IRQ,
91 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,
103 .id = 1,
104 .num_resources = ARRAY_SIZE(mv643xx_eth1_resources),
105 .resource = mv643xx_eth1_resources,
106 .dev = {
107 .platform_data = &eth1_pd,
111 static struct platform_device *mv643xx_eth_pd_devs[] __initdata = {
112 &mv643xx_eth_shared_device,
113 &eth0_device,
114 &eth1_device,
117 /***********/
118 /***********/
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)
126 u32 ALong;
128 if (mv643xx_reg_base == NULL)
129 mv643xx_reg_base = ioremap(PEGASOS2_MARVELL_REGBASE,
130 PEGASOS2_MARVELL_REGSIZE);
132 if (mv643xx_reg_base == NULL)
133 return -ENOMEM;
135 #ifdef BE_VERBOSE
136 printk("Pegasos II/Marvell MV64361: register remapped from %p to %p\n",
137 (void *)PEGASOS2_MARVELL_REGBASE, (void *)mv643xx_reg_base);
138 #endif
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);
145 ALong &= ~(1 << 19);
146 MV_WRITE(MV64340_BASE_ADDR_ENABLE, ALong);
148 ALong = 0x02;
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);
155 ALong &= ~(1 << 4);
156 MV_WRITE(MV643XX_ETH_BASE_ADDR_ENABLE_REG, ALong);
158 #ifdef BE_VERBOSE
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);
161 #endif
163 iounmap(mv643xx_reg_base);
164 mv643xx_reg_base = NULL;
166 return 1;
170 /***********/
171 /***********/
172 int mv643xx_eth_add_pds(void)
174 int ret = 0;
175 static struct pci_device_id pci_marvell_mv64360[] = {
176 { PCI_DEVICE(PCI_VENDOR_ID_MARVELL, PCI_DEVICE_ID_MARVELL_MV64360) },
180 #ifdef BE_VERBOSE
181 printk("Pegasos II/Marvell MV64361: init\n");
182 #endif
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;
200 #ifdef BE_VERBOSE
201 printk("Pegasos II/Marvell MV64361: Can't enable the "
202 "SRAM\n");
203 #endif
207 #ifdef BE_VERBOSE
208 printk("Pegasos II/Marvell MV64361: init is over\n");
209 #endif
211 return ret;
214 device_initcall(mv643xx_eth_add_pds);