1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include <linux/kernel.h>
21#include <linux/module.h>
22#include <linux/types.h>
23#include <linux/fcntl.h>
24#include <linux/gfp.h>
25#include <linux/interrupt.h>
26#include <linux/init.h>
27#include <linux/ioport.h>
28#include <linux/in.h>
29#include <linux/string.h>
30#include <linux/delay.h>
31#include <linux/errno.h>
32#include <linux/netdevice.h>
33#include <linux/etherdevice.h>
34#include <linux/skbuff.h>
35#include <linux/platform_device.h>
36#include <linux/dma-mapping.h>
37#include <linux/slab.h>
38#include <linux/pgtable.h>
39
40#include <asm/io.h>
41#include <asm/dma.h>
42
43static char xtsonic_string[] = "xtsonic";
44
45extern unsigned xtboard_nvram_valid(void);
46extern void xtboard_get_ether_addr(unsigned char *buf);
47
48#include "sonic.h"
49
50
51
52
53
54
55
56
57
58
59#undef SONIC_RBSIZE
60#define SONIC_RBSIZE 1524
61
62
63
64
65#define SONIC_MEM_SIZE 0x100
66
67
68
69
70#define SONIC_READ(reg) \
71 (0xffff & *((volatile unsigned int *)dev->base_addr+reg))
72
73#define SONIC_WRITE(reg,val) \
74 *((volatile unsigned int *)dev->base_addr+reg) = val
75
76
77
78
79
80
81static unsigned short known_revisions[] =
82{
83 0x101,
84 0xffff
85};
86
87static int xtsonic_open(struct net_device *dev)
88{
89 int retval;
90
91 retval = request_irq(dev->irq, sonic_interrupt, 0, "sonic", dev);
92 if (retval) {
93 printk(KERN_ERR "%s: unable to get IRQ %d.\n",
94 dev->name, dev->irq);
95 return -EAGAIN;
96 }
97
98 retval = sonic_open(dev);
99 if (retval)
100 free_irq(dev->irq, dev);
101 return retval;
102}
103
104static int xtsonic_close(struct net_device *dev)
105{
106 int err;
107 err = sonic_close(dev);
108 free_irq(dev->irq, dev);
109 return err;
110}
111
112static const struct net_device_ops xtsonic_netdev_ops = {
113 .ndo_open = xtsonic_open,
114 .ndo_stop = xtsonic_close,
115 .ndo_start_xmit = sonic_send_packet,
116 .ndo_get_stats = sonic_get_stats,
117 .ndo_set_rx_mode = sonic_multicast_list,
118 .ndo_tx_timeout = sonic_tx_timeout,
119 .ndo_validate_addr = eth_validate_addr,
120 .ndo_set_mac_address = eth_mac_addr,
121};
122
123static int __init sonic_probe1(struct net_device *dev)
124{
125 unsigned int silicon_revision;
126 struct sonic_local *lp = netdev_priv(dev);
127 unsigned int base_addr = dev->base_addr;
128 int i;
129 int err = 0;
130
131 if (!request_mem_region(base_addr, 0x100, xtsonic_string))
132 return -EBUSY;
133
134
135
136
137
138
139 silicon_revision = SONIC_READ(SONIC_SR);
140 i = 0;
141 while ((known_revisions[i] != 0xffff) &&
142 (known_revisions[i] != silicon_revision))
143 i++;
144
145 if (known_revisions[i] == 0xffff) {
146 pr_info("SONIC ethernet controller not found (0x%4x)\n",
147 silicon_revision);
148 return -ENODEV;
149 }
150
151
152
153
154
155 SONIC_WRITE(SONIC_CMD,SONIC_CR_RST);
156 SONIC_WRITE(SONIC_DCR,
157 SONIC_DCR_WC0|SONIC_DCR_DW|SONIC_DCR_LBR|SONIC_DCR_SBUS);
158 SONIC_WRITE(SONIC_CEP,0);
159 SONIC_WRITE(SONIC_IMR,0);
160
161 SONIC_WRITE(SONIC_CMD,SONIC_CR_RST);
162 SONIC_WRITE(SONIC_CEP,0);
163
164 for (i=0; i<3; i++) {
165 unsigned int val = SONIC_READ(SONIC_CAP0-i);
166 dev->dev_addr[i*2] = val;
167 dev->dev_addr[i*2+1] = val >> 8;
168 }
169
170 lp->dma_bitmode = SONIC_BITMODE32;
171
172 err = sonic_alloc_descriptors(dev);
173 if (err)
174 goto out;
175
176 dev->netdev_ops = &xtsonic_netdev_ops;
177 dev->watchdog_timeo = TX_TIMEOUT;
178
179
180
181
182 SONIC_WRITE(SONIC_CRCT,0xffff);
183 SONIC_WRITE(SONIC_FAET,0xffff);
184 SONIC_WRITE(SONIC_MPT,0xffff);
185
186 return 0;
187out:
188 release_region(dev->base_addr, SONIC_MEM_SIZE);
189 return err;
190}
191
192
193
194
195
196
197
198int xtsonic_probe(struct platform_device *pdev)
199{
200 struct net_device *dev;
201 struct sonic_local *lp;
202 struct resource *resmem, *resirq;
203 int err = 0;
204
205 if ((resmem = platform_get_resource(pdev, IORESOURCE_MEM, 0)) == NULL)
206 return -ENODEV;
207
208 if ((resirq = platform_get_resource(pdev, IORESOURCE_IRQ, 0)) == NULL)
209 return -ENODEV;
210
211 if ((dev = alloc_etherdev(sizeof(struct sonic_local))) == NULL)
212 return -ENOMEM;
213
214 lp = netdev_priv(dev);
215 lp->device = &pdev->dev;
216 platform_set_drvdata(pdev, dev);
217 SET_NETDEV_DEV(dev, &pdev->dev);
218 netdev_boot_setup_check(dev);
219
220 dev->base_addr = resmem->start;
221 dev->irq = resirq->start;
222
223 if ((err = sonic_probe1(dev)))
224 goto out;
225
226 pr_info("SONIC ethernet @%08lx, MAC %pM, IRQ %d\n",
227 dev->base_addr, dev->dev_addr, dev->irq);
228
229 sonic_msg_init(dev);
230
231 if ((err = register_netdev(dev)))
232 goto undo_probe1;
233
234 return 0;
235
236undo_probe1:
237 dma_free_coherent(lp->device,
238 SIZEOF_SONIC_DESC * SONIC_BUS_SCALE(lp->dma_bitmode),
239 lp->descriptors, lp->descriptors_laddr);
240 release_region(dev->base_addr, SONIC_MEM_SIZE);
241out:
242 free_netdev(dev);
243
244 return err;
245}
246
247MODULE_DESCRIPTION("Xtensa XT2000 SONIC ethernet driver");
248
249#include "sonic.c"
250
251static int xtsonic_device_remove(struct platform_device *pdev)
252{
253 struct net_device *dev = platform_get_drvdata(pdev);
254 struct sonic_local *lp = netdev_priv(dev);
255
256 unregister_netdev(dev);
257 dma_free_coherent(lp->device,
258 SIZEOF_SONIC_DESC * SONIC_BUS_SCALE(lp->dma_bitmode),
259 lp->descriptors, lp->descriptors_laddr);
260 release_region (dev->base_addr, SONIC_MEM_SIZE);
261 free_netdev(dev);
262
263 return 0;
264}
265
266static struct platform_driver xtsonic_driver = {
267 .probe = xtsonic_probe,
268 .remove = xtsonic_device_remove,
269 .driver = {
270 .name = xtsonic_string,
271 },
272};
273
274module_platform_driver(xtsonic_driver);
275