This source file includes following definitions.
- fdomain_make_bus_idle
- fdomain_identify
- fdomain_test_loopback
- fdomain_reset
- fdomain_select
- fdomain_finish_cmd
- fdomain_read_data
- fdomain_write_data
- fdomain_work
- fdomain_irq
- fdomain_queue
- fdomain_abort
- fdomain_host_reset
- fdomain_biosparam
- fdomain_create
- fdomain_destroy
- fdomain_resume
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
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82 #include <linux/module.h>
83 #include <linux/interrupt.h>
84 #include <linux/delay.h>
85 #include <linux/pci.h>
86 #include <linux/workqueue.h>
87 #include <scsi/scsicam.h>
88 #include <scsi/scsi_cmnd.h>
89 #include <scsi/scsi_device.h>
90 #include <scsi/scsi_host.h>
91 #include "fdomain.h"
92
93
94
95
96
97
98
99
100
101 #define FIFO_COUNT 2
102 #define PARITY_MASK ACTL_PAREN
103
104 enum chip_type {
105 unknown = 0x00,
106 tmc1800 = 0x01,
107 tmc18c50 = 0x02,
108 tmc18c30 = 0x03,
109 };
110
111 struct fdomain {
112 int base;
113 struct scsi_cmnd *cur_cmd;
114 enum chip_type chip;
115 struct work_struct work;
116 };
117
118 static inline void fdomain_make_bus_idle(struct fdomain *fd)
119 {
120 outb(0, fd->base + REG_BCTL);
121 outb(0, fd->base + REG_MCTL);
122 if (fd->chip == tmc18c50 || fd->chip == tmc18c30)
123
124 outb(ACTL_RESET | ACTL_CLRFIRQ | PARITY_MASK,
125 fd->base + REG_ACTL);
126 else
127 outb(ACTL_RESET | PARITY_MASK, fd->base + REG_ACTL);
128 }
129
130 static enum chip_type fdomain_identify(int port)
131 {
132 u16 id = inb(port + REG_ID_LSB) | inb(port + REG_ID_MSB) << 8;
133
134 switch (id) {
135 case 0x6127:
136 return tmc1800;
137 case 0x60e9:
138 break;
139 default:
140 return unknown;
141 }
142
143
144 outb(CFG2_32BIT, port + REG_CFG2);
145 if ((inb(port + REG_CFG2) & CFG2_32BIT)) {
146 outb(0, port + REG_CFG2);
147 if ((inb(port + REG_CFG2) & CFG2_32BIT) == 0)
148 return tmc18c30;
149 }
150
151 return tmc18c50;
152 }
153
154 static int fdomain_test_loopback(int base)
155 {
156 int i;
157
158 for (i = 0; i < 255; i++) {
159 outb(i, base + REG_LOOPBACK);
160 if (inb(base + REG_LOOPBACK) != i)
161 return 1;
162 }
163
164 return 0;
165 }
166
167 static void fdomain_reset(int base)
168 {
169 outb(BCTL_RST, base + REG_BCTL);
170 mdelay(20);
171 outb(0, base + REG_BCTL);
172 mdelay(1150);
173 outb(0, base + REG_MCTL);
174 outb(PARITY_MASK, base + REG_ACTL);
175 }
176
177 static int fdomain_select(struct Scsi_Host *sh, int target)
178 {
179 int status;
180 unsigned long timeout;
181 struct fdomain *fd = shost_priv(sh);
182
183 outb(BCTL_BUSEN | BCTL_SEL, fd->base + REG_BCTL);
184 outb(BIT(sh->this_id) | BIT(target), fd->base + REG_SCSI_DATA_NOACK);
185
186
187 outb(PARITY_MASK, fd->base + REG_ACTL);
188
189 timeout = 350;
190
191 do {
192 status = inb(fd->base + REG_BSTAT);
193 if (status & BSTAT_BSY) {
194
195
196 outb(BCTL_BUSEN, fd->base + REG_BCTL);
197 return 0;
198 }
199 mdelay(1);
200 } while (--timeout);
201 fdomain_make_bus_idle(fd);
202 return 1;
203 }
204
205 static void fdomain_finish_cmd(struct fdomain *fd, int result)
206 {
207 outb(0, fd->base + REG_ICTL);
208 fdomain_make_bus_idle(fd);
209 fd->cur_cmd->result = result;
210 fd->cur_cmd->scsi_done(fd->cur_cmd);
211 fd->cur_cmd = NULL;
212 }
213
214 static void fdomain_read_data(struct scsi_cmnd *cmd)
215 {
216 struct fdomain *fd = shost_priv(cmd->device->host);
217 unsigned char *virt, *ptr;
218 size_t offset, len;
219
220 while ((len = inw(fd->base + REG_FIFO_COUNT)) > 0) {
221 offset = scsi_bufflen(cmd) - scsi_get_resid(cmd);
222 virt = scsi_kmap_atomic_sg(scsi_sglist(cmd), scsi_sg_count(cmd),
223 &offset, &len);
224 ptr = virt + offset;
225 if (len & 1)
226 *ptr++ = inb(fd->base + REG_FIFO);
227 if (len > 1)
228 insw(fd->base + REG_FIFO, ptr, len >> 1);
229 scsi_set_resid(cmd, scsi_get_resid(cmd) - len);
230 scsi_kunmap_atomic_sg(virt);
231 }
232 }
233
234 static void fdomain_write_data(struct scsi_cmnd *cmd)
235 {
236 struct fdomain *fd = shost_priv(cmd->device->host);
237
238 int FIFO_Size = fd->chip == tmc18c30 ? 0x800 : 0x2000;
239 unsigned char *virt, *ptr;
240 size_t offset, len;
241
242 while ((len = FIFO_Size - inw(fd->base + REG_FIFO_COUNT)) > 512) {
243 offset = scsi_bufflen(cmd) - scsi_get_resid(cmd);
244 if (len + offset > scsi_bufflen(cmd)) {
245 len = scsi_bufflen(cmd) - offset;
246 if (len == 0)
247 break;
248 }
249 virt = scsi_kmap_atomic_sg(scsi_sglist(cmd), scsi_sg_count(cmd),
250 &offset, &len);
251 ptr = virt + offset;
252 if (len & 1)
253 outb(*ptr++, fd->base + REG_FIFO);
254 if (len > 1)
255 outsw(fd->base + REG_FIFO, ptr, len >> 1);
256 scsi_set_resid(cmd, scsi_get_resid(cmd) - len);
257 scsi_kunmap_atomic_sg(virt);
258 }
259 }
260
261 static void fdomain_work(struct work_struct *work)
262 {
263 struct fdomain *fd = container_of(work, struct fdomain, work);
264 struct Scsi_Host *sh = container_of((void *)fd, struct Scsi_Host,
265 hostdata);
266 struct scsi_cmnd *cmd = fd->cur_cmd;
267 unsigned long flags;
268 int status;
269 int done = 0;
270
271 spin_lock_irqsave(sh->host_lock, flags);
272
273 if (cmd->SCp.phase & in_arbitration) {
274 status = inb(fd->base + REG_ASTAT);
275 if (!(status & ASTAT_ARB)) {
276 fdomain_finish_cmd(fd, DID_BUS_BUSY << 16);
277 goto out;
278 }
279 cmd->SCp.phase = in_selection;
280
281 outb(ICTL_SEL | FIFO_COUNT, fd->base + REG_ICTL);
282 outb(BCTL_BUSEN | BCTL_SEL, fd->base + REG_BCTL);
283 outb(BIT(cmd->device->host->this_id) | BIT(scmd_id(cmd)),
284 fd->base + REG_SCSI_DATA_NOACK);
285
286 outb(ACTL_IRQEN | PARITY_MASK, fd->base + REG_ACTL);
287 goto out;
288 } else if (cmd->SCp.phase & in_selection) {
289 status = inb(fd->base + REG_BSTAT);
290 if (!(status & BSTAT_BSY)) {
291
292 if (fdomain_select(cmd->device->host, scmd_id(cmd))) {
293 fdomain_finish_cmd(fd, DID_NO_CONNECT << 16);
294 goto out;
295 }
296
297 outb(ACTL_IRQEN | PARITY_MASK, fd->base + REG_ACTL);
298 }
299 cmd->SCp.phase = in_other;
300 outb(ICTL_FIFO | ICTL_REQ | FIFO_COUNT, fd->base + REG_ICTL);
301 outb(BCTL_BUSEN, fd->base + REG_BCTL);
302 goto out;
303 }
304
305
306 status = inb(fd->base + REG_BSTAT);
307
308 if (status & BSTAT_REQ) {
309 switch (status & (BSTAT_MSG | BSTAT_CMD | BSTAT_IO)) {
310 case BSTAT_CMD:
311 outb(cmd->cmnd[cmd->SCp.sent_command++],
312 fd->base + REG_SCSI_DATA);
313 break;
314 case 0:
315 if (fd->chip != tmc1800 && !cmd->SCp.have_data_in) {
316 cmd->SCp.have_data_in = -1;
317 outb(ACTL_IRQEN | ACTL_FIFOWR | ACTL_FIFOEN |
318 PARITY_MASK, fd->base + REG_ACTL);
319 }
320 break;
321 case BSTAT_IO:
322 if (fd->chip != tmc1800 && !cmd->SCp.have_data_in) {
323 cmd->SCp.have_data_in = 1;
324 outb(ACTL_IRQEN | ACTL_FIFOEN | PARITY_MASK,
325 fd->base + REG_ACTL);
326 }
327 break;
328 case BSTAT_CMD | BSTAT_IO:
329 cmd->SCp.Status = inb(fd->base + REG_SCSI_DATA);
330 break;
331 case BSTAT_MSG | BSTAT_CMD:
332 outb(MESSAGE_REJECT, fd->base + REG_SCSI_DATA);
333 break;
334 case BSTAT_MSG | BSTAT_CMD | BSTAT_IO:
335 cmd->SCp.Message = inb(fd->base + REG_SCSI_DATA);
336 if (!cmd->SCp.Message)
337 ++done;
338 break;
339 }
340 }
341
342 if (fd->chip == tmc1800 && !cmd->SCp.have_data_in &&
343 cmd->SCp.sent_command >= cmd->cmd_len) {
344 if (cmd->sc_data_direction == DMA_TO_DEVICE) {
345 cmd->SCp.have_data_in = -1;
346 outb(ACTL_IRQEN | ACTL_FIFOWR | ACTL_FIFOEN |
347 PARITY_MASK, fd->base + REG_ACTL);
348 } else {
349 cmd->SCp.have_data_in = 1;
350 outb(ACTL_IRQEN | ACTL_FIFOEN | PARITY_MASK,
351 fd->base + REG_ACTL);
352 }
353 }
354
355 if (cmd->SCp.have_data_in == -1)
356 fdomain_write_data(cmd);
357
358 if (cmd->SCp.have_data_in == 1)
359 fdomain_read_data(cmd);
360
361 if (done) {
362 fdomain_finish_cmd(fd, (cmd->SCp.Status & 0xff) |
363 ((cmd->SCp.Message & 0xff) << 8) |
364 (DID_OK << 16));
365 } else {
366 if (cmd->SCp.phase & disconnect) {
367 outb(ICTL_FIFO | ICTL_SEL | ICTL_REQ | FIFO_COUNT,
368 fd->base + REG_ICTL);
369 outb(0, fd->base + REG_BCTL);
370 } else
371 outb(ICTL_FIFO | ICTL_REQ | FIFO_COUNT,
372 fd->base + REG_ICTL);
373 }
374 out:
375 spin_unlock_irqrestore(sh->host_lock, flags);
376 }
377
378 static irqreturn_t fdomain_irq(int irq, void *dev_id)
379 {
380 struct fdomain *fd = dev_id;
381
382
383 if ((inb(fd->base + REG_ASTAT) & ASTAT_IRQ) == 0)
384 return IRQ_NONE;
385
386 outb(0, fd->base + REG_ICTL);
387
388
389 if (!fd->cur_cmd)
390 return IRQ_NONE;
391
392 schedule_work(&fd->work);
393
394 return IRQ_HANDLED;
395 }
396
397 static int fdomain_queue(struct Scsi_Host *sh, struct scsi_cmnd *cmd)
398 {
399 struct fdomain *fd = shost_priv(cmd->device->host);
400 unsigned long flags;
401
402 cmd->SCp.Status = 0;
403 cmd->SCp.Message = 0;
404 cmd->SCp.have_data_in = 0;
405 cmd->SCp.sent_command = 0;
406 cmd->SCp.phase = in_arbitration;
407 scsi_set_resid(cmd, scsi_bufflen(cmd));
408
409 spin_lock_irqsave(sh->host_lock, flags);
410
411 fd->cur_cmd = cmd;
412
413 fdomain_make_bus_idle(fd);
414
415
416 outb(0, fd->base + REG_ICTL);
417 outb(0, fd->base + REG_BCTL);
418
419 outb(BIT(cmd->device->host->this_id), fd->base + REG_SCSI_DATA_NOACK);
420 outb(ICTL_ARB, fd->base + REG_ICTL);
421
422 outb(ACTL_ARB | ACTL_IRQEN | PARITY_MASK, fd->base + REG_ACTL);
423
424 spin_unlock_irqrestore(sh->host_lock, flags);
425
426 return 0;
427 }
428
429 static int fdomain_abort(struct scsi_cmnd *cmd)
430 {
431 struct Scsi_Host *sh = cmd->device->host;
432 struct fdomain *fd = shost_priv(sh);
433 unsigned long flags;
434
435 if (!fd->cur_cmd)
436 return FAILED;
437
438 spin_lock_irqsave(sh->host_lock, flags);
439
440 fdomain_make_bus_idle(fd);
441 fd->cur_cmd->SCp.phase |= aborted;
442 fd->cur_cmd->result = DID_ABORT << 16;
443
444
445 fdomain_finish_cmd(fd, DID_ABORT << 16);
446 spin_unlock_irqrestore(sh->host_lock, flags);
447 return SUCCESS;
448 }
449
450 static int fdomain_host_reset(struct scsi_cmnd *cmd)
451 {
452 struct Scsi_Host *sh = cmd->device->host;
453 struct fdomain *fd = shost_priv(sh);
454 unsigned long flags;
455
456 spin_lock_irqsave(sh->host_lock, flags);
457 fdomain_reset(fd->base);
458 spin_unlock_irqrestore(sh->host_lock, flags);
459 return SUCCESS;
460 }
461
462 static int fdomain_biosparam(struct scsi_device *sdev,
463 struct block_device *bdev, sector_t capacity,
464 int geom[])
465 {
466 unsigned char *p = scsi_bios_ptable(bdev);
467
468 if (p && p[65] == 0xaa && p[64] == 0x55
469 && p[4]) {
470 geom[0] = p[5] + 1;
471 geom[1] = p[6] & 0x3f;
472 } else {
473 if (capacity >= 0x7e0000) {
474 geom[0] = 255;
475 geom[1] = 63;
476 } else if (capacity >= 0x200000) {
477 geom[0] = 128;
478 geom[1] = 63;
479 } else {
480 geom[0] = 64;
481 geom[1] = 32;
482 }
483 }
484 geom[2] = sector_div(capacity, geom[0] * geom[1]);
485 kfree(p);
486
487 return 0;
488 }
489
490 static struct scsi_host_template fdomain_template = {
491 .module = THIS_MODULE,
492 .name = "Future Domain TMC-16x0",
493 .proc_name = "fdomain",
494 .queuecommand = fdomain_queue,
495 .eh_abort_handler = fdomain_abort,
496 .eh_host_reset_handler = fdomain_host_reset,
497 .bios_param = fdomain_biosparam,
498 .can_queue = 1,
499 .this_id = 7,
500 .sg_tablesize = 64,
501 .dma_boundary = PAGE_SIZE - 1,
502 };
503
504 struct Scsi_Host *fdomain_create(int base, int irq, int this_id,
505 struct device *dev)
506 {
507 struct Scsi_Host *sh;
508 struct fdomain *fd;
509 enum chip_type chip;
510 static const char * const chip_names[] = {
511 "Unknown", "TMC-1800", "TMC-18C50", "TMC-18C30"
512 };
513 unsigned long irq_flags = 0;
514
515 chip = fdomain_identify(base);
516 if (!chip)
517 return NULL;
518
519 fdomain_reset(base);
520
521 if (fdomain_test_loopback(base))
522 return NULL;
523
524 if (!irq) {
525 dev_err(dev, "card has no IRQ assigned");
526 return NULL;
527 }
528
529 sh = scsi_host_alloc(&fdomain_template, sizeof(struct fdomain));
530 if (!sh)
531 return NULL;
532
533 if (this_id)
534 sh->this_id = this_id & 0x07;
535
536 sh->irq = irq;
537 sh->io_port = base;
538 sh->n_io_port = FDOMAIN_REGION_SIZE;
539
540 fd = shost_priv(sh);
541 fd->base = base;
542 fd->chip = chip;
543 INIT_WORK(&fd->work, fdomain_work);
544
545 if (dev_is_pci(dev) || !strcmp(dev->bus->name, "pcmcia"))
546 irq_flags = IRQF_SHARED;
547
548 if (request_irq(irq, fdomain_irq, irq_flags, "fdomain", fd))
549 goto fail_put;
550
551 shost_printk(KERN_INFO, sh, "%s chip at 0x%x irq %d SCSI ID %d\n",
552 dev_is_pci(dev) ? "TMC-36C70 (PCI bus)" : chip_names[chip],
553 base, irq, sh->this_id);
554
555 if (scsi_add_host(sh, dev))
556 goto fail_free_irq;
557
558 scsi_scan_host(sh);
559
560 return sh;
561
562 fail_free_irq:
563 free_irq(irq, fd);
564 fail_put:
565 scsi_host_put(sh);
566 return NULL;
567 }
568 EXPORT_SYMBOL_GPL(fdomain_create);
569
570 int fdomain_destroy(struct Scsi_Host *sh)
571 {
572 struct fdomain *fd = shost_priv(sh);
573
574 cancel_work_sync(&fd->work);
575 scsi_remove_host(sh);
576 if (sh->irq)
577 free_irq(sh->irq, fd);
578 scsi_host_put(sh);
579 return 0;
580 }
581 EXPORT_SYMBOL_GPL(fdomain_destroy);
582
583 #ifdef CONFIG_PM_SLEEP
584 static int fdomain_resume(struct device *dev)
585 {
586 struct fdomain *fd = shost_priv(dev_get_drvdata(dev));
587
588 fdomain_reset(fd->base);
589 return 0;
590 }
591
592 static SIMPLE_DEV_PM_OPS(fdomain_pm_ops, NULL, fdomain_resume);
593 #endif
594
595 MODULE_AUTHOR("Ondrej Zary, Rickard E. Faith");
596 MODULE_DESCRIPTION("Future Domain TMC-16x0/TMC-3260 SCSI driver");
597 MODULE_LICENSE("GPL");