1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29#include <linux/module.h>
30#include <linux/kernel.h>
31#include <linux/errno.h>
32#include <linux/pci.h>
33#include <linux/init.h>
34#include <linux/netdevice.h>
35#include <linux/trdevice.h>
36
37#include <asm/system.h>
38#include <asm/io.h>
39#include <asm/irq.h>
40
41#include "tms380tr.h"
42
43static char version[] __devinitdata =
44"tmspci.c: v1.02 23/11/2000 by Adam Fritzler\n";
45
46#define TMS_PCI_IO_EXTENT 32
47
48struct card_info {
49 unsigned char nselout[2];
50 char *name;
51};
52
53static struct card_info card_info_table[] = {
54 { {0x03, 0x01}, "Compaq 4/16 TR PCI"},
55 { {0x03, 0x01}, "SK NET TR 4/16 PCI"},
56 { {0x03, 0x01}, "Thomas-Conrad TC4048 PCI 4/16"},
57 { {0x03, 0x01}, "3Com Token Link Velocity"},
58};
59
60static struct pci_device_id tmspci_pci_tbl[] = {
61 { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_TOKENRING, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
62 { PCI_VENDOR_ID_SYSKONNECT, PCI_DEVICE_ID_SYSKONNECT_TR, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 1 },
63 { PCI_VENDOR_ID_TCONRAD, PCI_DEVICE_ID_TCONRAD_TOKENRING, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 2 },
64 { PCI_VENDOR_ID_3COM, PCI_DEVICE_ID_3COM_3C339, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 3 },
65 { }
66};
67MODULE_DEVICE_TABLE(pci, tmspci_pci_tbl);
68
69MODULE_LICENSE("GPL");
70
71static void tms_pci_read_eeprom(struct net_device *dev);
72static unsigned short tms_pci_setnselout_pins(struct net_device *dev);
73
74static unsigned short tms_pci_sifreadb(struct net_device *dev, unsigned short reg)
75{
76 return inb(dev->base_addr + reg);
77}
78
79static unsigned short tms_pci_sifreadw(struct net_device *dev, unsigned short reg)
80{
81 return inw(dev->base_addr + reg);
82}
83
84static void tms_pci_sifwriteb(struct net_device *dev, unsigned short val, unsigned short reg)
85{
86 outb(val, dev->base_addr + reg);
87}
88
89static void tms_pci_sifwritew(struct net_device *dev, unsigned short val, unsigned short reg)
90{
91 outw(val, dev->base_addr + reg);
92}
93
94static int __devinit tms_pci_attach(struct pci_dev *pdev, const struct pci_device_id *ent)
95{
96 static int versionprinted;
97 struct net_device *dev;
98 struct net_local *tp;
99 int ret;
100 unsigned int pci_irq_line;
101 unsigned long pci_ioaddr;
102 struct card_info *cardinfo = &card_info_table[ent->driver_data];
103
104 if (versionprinted++ == 0)
105 printk("%s", version);
106
107 if (pci_enable_device(pdev))
108 return -EIO;
109
110
111 pci_irq_line = pdev->irq;
112 pci_ioaddr = pci_resource_start (pdev, 0);
113
114
115 dev = alloc_trdev(sizeof(struct net_local));
116 if (!dev)
117 return -ENOMEM;
118
119 if (!request_region(pci_ioaddr, TMS_PCI_IO_EXTENT, dev->name)) {
120 ret = -EBUSY;
121 goto err_out_trdev;
122 }
123
124 dev->base_addr = pci_ioaddr;
125 dev->irq = pci_irq_line;
126 dev->dma = 0;
127
128 printk("%s: %s\n", dev->name, cardinfo->name);
129 printk("%s: IO: %#4lx IRQ: %d\n",
130 dev->name, dev->base_addr, dev->irq);
131
132 tms_pci_read_eeprom(dev);
133
134 printk("%s: Ring Station Address: %pM\n",
135 dev->name, dev->dev_addr);
136
137 ret = tmsdev_init(dev, &pdev->dev);
138 if (ret) {
139 printk("%s: unable to get memory for dev->priv.\n", dev->name);
140 goto err_out_region;
141 }
142
143 tp = netdev_priv(dev);
144 tp->setnselout = tms_pci_setnselout_pins;
145
146 tp->sifreadb = tms_pci_sifreadb;
147 tp->sifreadw = tms_pci_sifreadw;
148 tp->sifwriteb = tms_pci_sifwriteb;
149 tp->sifwritew = tms_pci_sifwritew;
150
151 memcpy(tp->ProductID, cardinfo->name, PROD_ID_SIZE + 1);
152
153 tp->tmspriv = cardinfo;
154
155 dev->netdev_ops = &tms380tr_netdev_ops;
156
157 ret = request_irq(pdev->irq, tms380tr_interrupt, IRQF_SHARED,
158 dev->name, dev);
159 if (ret)
160 goto err_out_tmsdev;
161
162 pci_set_drvdata(pdev, dev);
163 SET_NETDEV_DEV(dev, &pdev->dev);
164
165 ret = register_netdev(dev);
166 if (ret)
167 goto err_out_irq;
168
169 return 0;
170
171err_out_irq:
172 free_irq(pdev->irq, dev);
173err_out_tmsdev:
174 pci_set_drvdata(pdev, NULL);
175 tmsdev_term(dev);
176err_out_region:
177 release_region(pci_ioaddr, TMS_PCI_IO_EXTENT);
178err_out_trdev:
179 free_netdev(dev);
180 return ret;
181}
182
183
184
185
186
187
188
189
190
191
192static void tms_pci_read_eeprom(struct net_device *dev)
193{
194 int i;
195
196
197 tms_pci_sifwritew(dev, 0, SIFADX);
198 tms_pci_sifwritew(dev, 0, SIFADR);
199
200
201 dev->addr_len = 6;
202 for(i = 0; i < 6; i++)
203 dev->dev_addr[i] = tms_pci_sifreadw(dev, SIFINC) >> 8;
204}
205
206static unsigned short tms_pci_setnselout_pins(struct net_device *dev)
207{
208 unsigned short val = 0;
209 struct net_local *tp = netdev_priv(dev);
210 struct card_info *cardinfo = tp->tmspriv;
211
212 if(tp->DataRate == SPEED_4)
213 val |= cardinfo->nselout[0];
214 else
215 val |= cardinfo->nselout[1];
216 return val;
217}
218
219static void __devexit tms_pci_detach (struct pci_dev *pdev)
220{
221 struct net_device *dev = pci_get_drvdata(pdev);
222
223 BUG_ON(!dev);
224 unregister_netdev(dev);
225 release_region(dev->base_addr, TMS_PCI_IO_EXTENT);
226 free_irq(dev->irq, dev);
227 tmsdev_term(dev);
228 free_netdev(dev);
229 pci_set_drvdata(pdev, NULL);
230}
231
232static struct pci_driver tms_pci_driver = {
233 .name = "tmspci",
234 .id_table = tmspci_pci_tbl,
235 .probe = tms_pci_attach,
236 .remove = __devexit_p(tms_pci_detach),
237};
238
239static int __init tms_pci_init (void)
240{
241 return pci_register_driver(&tms_pci_driver);
242}
243
244static void __exit tms_pci_rmmod (void)
245{
246 pci_unregister_driver (&tms_pci_driver);
247}
248
249module_init(tms_pci_init);
250module_exit(tms_pci_rmmod);
251
252