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#include <linux/errno.h>
29#include <linux/module.h>
30#include <linux/pci.h>
31#include <linux/ioc4.h>
32#include <linux/ktime.h>
33#include <linux/slab.h>
34#include <linux/mutex.h>
35#include <linux/time.h>
36#include <asm/io.h>
37
38
39
40
41
42
43
44
45#define IOC4_CALIBRATE_COUNT 63
46#define IOC4_CALIBRATE_CYCLES 256
47#define IOC4_CALIBRATE_DISCARD 2
48#define IOC4_CALIBRATE_LOW_MHZ 25
49#define IOC4_CALIBRATE_HIGH_MHZ 75
50#define IOC4_CALIBRATE_DEFAULT_MHZ 66
51
52
53
54
55
56static DEFINE_MUTEX(ioc4_mutex);
57
58static LIST_HEAD(ioc4_devices);
59static LIST_HEAD(ioc4_submodules);
60
61
62int
63ioc4_register_submodule(struct ioc4_submodule *is)
64{
65 struct ioc4_driver_data *idd;
66
67 mutex_lock(&ioc4_mutex);
68 list_add(&is->is_list, &ioc4_submodules);
69
70
71 if (!is->is_probe)
72 goto out;
73
74 list_for_each_entry(idd, &ioc4_devices, idd_list) {
75 if (is->is_probe(idd)) {
76 printk(KERN_WARNING
77 "%s: IOC4 submodule %s probe failed "
78 "for pci_dev %s",
79 __func__, module_name(is->is_owner),
80 pci_name(idd->idd_pdev));
81 }
82 }
83 out:
84 mutex_unlock(&ioc4_mutex);
85 return 0;
86}
87
88
89void
90ioc4_unregister_submodule(struct ioc4_submodule *is)
91{
92 struct ioc4_driver_data *idd;
93
94 mutex_lock(&ioc4_mutex);
95 list_del(&is->is_list);
96
97
98 if (!is->is_remove)
99 goto out;
100
101 list_for_each_entry(idd, &ioc4_devices, idd_list) {
102 if (is->is_remove(idd)) {
103 printk(KERN_WARNING
104 "%s: IOC4 submodule %s remove failed "
105 "for pci_dev %s.\n",
106 __func__, module_name(is->is_owner),
107 pci_name(idd->idd_pdev));
108 }
109 }
110 out:
111 mutex_unlock(&ioc4_mutex);
112}
113
114
115
116
117
118#define IOC4_CALIBRATE_LOW_LIMIT \
119 (1000*IOC4_EXTINT_COUNT_DIVISOR/IOC4_CALIBRATE_LOW_MHZ)
120#define IOC4_CALIBRATE_HIGH_LIMIT \
121 (1000*IOC4_EXTINT_COUNT_DIVISOR/IOC4_CALIBRATE_HIGH_MHZ)
122#define IOC4_CALIBRATE_DEFAULT \
123 (1000*IOC4_EXTINT_COUNT_DIVISOR/IOC4_CALIBRATE_DEFAULT_MHZ)
124
125#define IOC4_CALIBRATE_END \
126 (IOC4_CALIBRATE_CYCLES + IOC4_CALIBRATE_DISCARD)
127
128#define IOC4_INT_OUT_MODE_TOGGLE 0x7
129
130
131
132
133
134
135
136
137
138
139
140
141
142static void
143ioc4_clock_calibrate(struct ioc4_driver_data *idd)
144{
145 union ioc4_int_out int_out;
146 union ioc4_gpcr gpcr;
147 unsigned int state, last_state;
148 uint64_t start, end, period;
149 unsigned int count;
150
151
152 gpcr.raw = 0;
153 gpcr.fields.dir = IOC4_GPCR_DIR_0;
154 gpcr.fields.int_out_en = 1;
155 writel(gpcr.raw, &idd->idd_misc_regs->gpcr_s.raw);
156
157
158 writel(0, &idd->idd_misc_regs->int_out.raw);
159 mmiowb();
160
161
162 int_out.raw = 0;
163 int_out.fields.count = IOC4_CALIBRATE_COUNT;
164 int_out.fields.mode = IOC4_INT_OUT_MODE_TOGGLE;
165 int_out.fields.diag = 0;
166 writel(int_out.raw, &idd->idd_misc_regs->int_out.raw);
167 mmiowb();
168
169
170 start = ktime_get_ns();
171 state = 1;
172 for (count = 0; count <= IOC4_CALIBRATE_END; count++) {
173 do {
174 last_state = state;
175 int_out.raw = readl(&idd->idd_misc_regs->int_out.raw);
176 state = int_out.fields.int_out;
177 } while (last_state || !state);
178
179
180 if (count == IOC4_CALIBRATE_DISCARD)
181 start = ktime_get_ns();
182 }
183 end = ktime_get_ns();
184
185
186
187
188
189
190
191
192
193
194
195 period = (end - start) /
196 (IOC4_CALIBRATE_CYCLES * 2 * (IOC4_CALIBRATE_COUNT + 1));
197
198
199 if (period > IOC4_CALIBRATE_LOW_LIMIT ||
200 period < IOC4_CALIBRATE_HIGH_LIMIT) {
201 printk(KERN_INFO
202 "IOC4 %s: Clock calibration failed. Assuming"
203 "PCI clock is %d ns.\n",
204 pci_name(idd->idd_pdev),
205 IOC4_CALIBRATE_DEFAULT / IOC4_EXTINT_COUNT_DIVISOR);
206 period = IOC4_CALIBRATE_DEFAULT;
207 } else {
208 u64 ns = period;
209
210 do_div(ns, IOC4_EXTINT_COUNT_DIVISOR);
211 printk(KERN_DEBUG
212 "IOC4 %s: PCI clock is %llu ns.\n",
213 pci_name(idd->idd_pdev), (unsigned long long)ns);
214 }
215
216
217
218
219
220
221 idd->count_period = period;
222}
223
224
225
226
227
228
229
230
231
232static unsigned int
233ioc4_variant(struct ioc4_driver_data *idd)
234{
235 struct pci_dev *pdev = NULL;
236 int found = 0;
237
238
239 do {
240 pdev = pci_get_device(PCI_VENDOR_ID_QLOGIC,
241 PCI_DEVICE_ID_QLOGIC_ISP12160, pdev);
242 if (pdev &&
243 idd->idd_pdev->bus->number == pdev->bus->number &&
244 3 == PCI_SLOT(pdev->devfn))
245 found = 1;
246 } while (pdev && !found);
247 if (NULL != pdev) {
248 pci_dev_put(pdev);
249 return IOC4_VARIANT_IO9;
250 }
251
252
253 pdev = NULL;
254 do {
255 pdev = pci_get_device(PCI_VENDOR_ID_VITESSE,
256 PCI_DEVICE_ID_VITESSE_VSC7174, pdev);
257 if (pdev &&
258 idd->idd_pdev->bus->number == pdev->bus->number &&
259 3 == PCI_SLOT(pdev->devfn))
260 found = 1;
261 } while (pdev && !found);
262 if (NULL != pdev) {
263 pci_dev_put(pdev);
264 return IOC4_VARIANT_IO10;
265 }
266
267
268 return IOC4_VARIANT_PCI_RT;
269}
270
271static void
272ioc4_load_modules(struct work_struct *work)
273{
274 request_module("sgiioc4");
275}
276
277static DECLARE_WORK(ioc4_load_modules_work, ioc4_load_modules);
278
279
280static int
281ioc4_probe(struct pci_dev *pdev, const struct pci_device_id *pci_id)
282{
283 struct ioc4_driver_data *idd;
284 struct ioc4_submodule *is;
285 uint32_t pcmd;
286 int ret;
287
288
289 if ((ret = pci_enable_device(pdev))) {
290 printk(KERN_WARNING
291 "%s: Failed to enable IOC4 device for pci_dev %s.\n",
292 __func__, pci_name(pdev));
293 goto out;
294 }
295 pci_set_master(pdev);
296
297
298 idd = kmalloc(sizeof(struct ioc4_driver_data), GFP_KERNEL);
299 if (!idd) {
300 printk(KERN_WARNING
301 "%s: Failed to allocate IOC4 data for pci_dev %s.\n",
302 __func__, pci_name(pdev));
303 ret = -ENODEV;
304 goto out_idd;
305 }
306 idd->idd_pdev = pdev;
307 idd->idd_pci_id = pci_id;
308
309
310
311
312 idd->idd_bar0 = pci_resource_start(idd->idd_pdev, 0);
313 if (!idd->idd_bar0) {
314 printk(KERN_WARNING
315 "%s: Unable to find IOC4 misc resource "
316 "for pci_dev %s.\n",
317 __func__, pci_name(idd->idd_pdev));
318 ret = -ENODEV;
319 goto out_pci;
320 }
321 if (!request_mem_region(idd->idd_bar0, sizeof(struct ioc4_misc_regs),
322 "ioc4_misc")) {
323 printk(KERN_WARNING
324 "%s: Unable to request IOC4 misc region "
325 "for pci_dev %s.\n",
326 __func__, pci_name(idd->idd_pdev));
327 ret = -ENODEV;
328 goto out_pci;
329 }
330 idd->idd_misc_regs = ioremap(idd->idd_bar0,
331 sizeof(struct ioc4_misc_regs));
332 if (!idd->idd_misc_regs) {
333 printk(KERN_WARNING
334 "%s: Unable to remap IOC4 misc region "
335 "for pci_dev %s.\n",
336 __func__, pci_name(idd->idd_pdev));
337 ret = -ENODEV;
338 goto out_misc_region;
339 }
340
341
342
343
344 idd->idd_variant = ioc4_variant(idd);
345 printk(KERN_INFO "IOC4 %s: %s card detected.\n", pci_name(pdev),
346 idd->idd_variant == IOC4_VARIANT_IO9 ? "IO9" :
347 idd->idd_variant == IOC4_VARIANT_PCI_RT ? "PCI-RT" :
348 idd->idd_variant == IOC4_VARIANT_IO10 ? "IO10" : "unknown");
349
350
351 pci_read_config_dword(idd->idd_pdev, PCI_COMMAND, &pcmd);
352 pci_write_config_dword(idd->idd_pdev, PCI_COMMAND,
353 pcmd | PCI_COMMAND_PARITY | PCI_COMMAND_SERR);
354
355
356 ioc4_clock_calibrate(idd);
357
358
359
360
361
362
363 writel(~0, &idd->idd_misc_regs->other_iec.raw);
364 writel(~0, &idd->idd_misc_regs->sio_iec);
365
366 writel(~0, &idd->idd_misc_regs->other_ir.raw);
367 writel(~0, &idd->idd_misc_regs->sio_ir);
368
369
370 idd->idd_serial_data = NULL;
371 pci_set_drvdata(idd->idd_pdev, idd);
372
373 mutex_lock(&ioc4_mutex);
374 list_add_tail(&idd->idd_list, &ioc4_devices);
375
376
377 list_for_each_entry(is, &ioc4_submodules, is_list) {
378 if (is->is_probe && is->is_probe(idd)) {
379 printk(KERN_WARNING
380 "%s: IOC4 submodule 0x%s probe failed "
381 "for pci_dev %s.\n",
382 __func__, module_name(is->is_owner),
383 pci_name(idd->idd_pdev));
384 }
385 }
386 mutex_unlock(&ioc4_mutex);
387
388
389
390
391
392
393
394 if (idd->idd_variant != IOC4_VARIANT_PCI_RT) {
395
396
397
398
399 printk(KERN_INFO "IOC4 loading sgiioc4 submodule\n");
400 schedule_work(&ioc4_load_modules_work);
401 }
402
403 return 0;
404
405out_misc_region:
406 release_mem_region(idd->idd_bar0, sizeof(struct ioc4_misc_regs));
407out_pci:
408 kfree(idd);
409out_idd:
410 pci_disable_device(pdev);
411out:
412 return ret;
413}
414
415
416static void
417ioc4_remove(struct pci_dev *pdev)
418{
419 struct ioc4_submodule *is;
420 struct ioc4_driver_data *idd;
421
422 idd = pci_get_drvdata(pdev);
423
424
425 mutex_lock(&ioc4_mutex);
426 list_for_each_entry(is, &ioc4_submodules, is_list) {
427 if (is->is_remove && is->is_remove(idd)) {
428 printk(KERN_WARNING
429 "%s: IOC4 submodule 0x%s remove failed "
430 "for pci_dev %s.\n",
431 __func__, module_name(is->is_owner),
432 pci_name(idd->idd_pdev));
433 }
434 }
435 mutex_unlock(&ioc4_mutex);
436
437
438 iounmap(idd->idd_misc_regs);
439 if (!idd->idd_bar0) {
440 printk(KERN_WARNING
441 "%s: Unable to get IOC4 misc mapping for pci_dev %s. "
442 "Device removal may be incomplete.\n",
443 __func__, pci_name(idd->idd_pdev));
444 }
445 release_mem_region(idd->idd_bar0, sizeof(struct ioc4_misc_regs));
446
447
448 pci_disable_device(pdev);
449
450
451 mutex_lock(&ioc4_mutex);
452 list_del(&idd->idd_list);
453 mutex_unlock(&ioc4_mutex);
454 kfree(idd);
455}
456
457static struct pci_device_id ioc4_id_table[] = {
458 {PCI_VENDOR_ID_SGI, PCI_DEVICE_ID_SGI_IOC4, PCI_ANY_ID,
459 PCI_ANY_ID, 0x0b4000, 0xFFFFFF},
460 {0}
461};
462
463static struct pci_driver ioc4_driver = {
464 .name = "IOC4",
465 .id_table = ioc4_id_table,
466 .probe = ioc4_probe,
467 .remove = ioc4_remove,
468};
469
470MODULE_DEVICE_TABLE(pci, ioc4_id_table);
471
472
473
474
475
476
477static int __init
478ioc4_init(void)
479{
480 return pci_register_driver(&ioc4_driver);
481}
482
483
484static void __exit
485ioc4_exit(void)
486{
487
488 flush_work(&ioc4_load_modules_work);
489 pci_unregister_driver(&ioc4_driver);
490}
491
492module_init(ioc4_init);
493module_exit(ioc4_exit);
494
495MODULE_AUTHOR("Brent Casavant - Silicon Graphics, Inc. <bcasavan@sgi.com>");
496MODULE_DESCRIPTION("PCI driver master module for SGI IOC4 Base-IO Card");
497MODULE_LICENSE("GPL");
498
499EXPORT_SYMBOL(ioc4_register_submodule);
500EXPORT_SYMBOL(ioc4_unregister_submodule);
501