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
104enum chip_type {
105 unknown = 0x00,
106 tmc1800 = 0x01,
107 tmc18c50 = 0x02,
108 tmc18c30 = 0x03,
109};
110
111struct fdomain {
112 int base;
113 struct scsi_cmnd *cur_cmd;
114 enum chip_type chip;
115 struct work_struct work;
116};
117
118static 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
130static 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
154static 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
167static 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
177static 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
205static void fdomain_finish_cmd(struct fdomain *fd)
206{
207 outb(0, fd->base + REG_ICTL);
208 fdomain_make_bus_idle(fd);
209 fd->cur_cmd->scsi_done(fd->cur_cmd);
210 fd->cur_cmd = NULL;
211}
212
213static void fdomain_read_data(struct scsi_cmnd *cmd)
214{
215 struct fdomain *fd = shost_priv(cmd->device->host);
216 unsigned char *virt, *ptr;
217 size_t offset, len;
218
219 while ((len = inw(fd->base + REG_FIFO_COUNT)) > 0) {
220 offset = scsi_bufflen(cmd) - scsi_get_resid(cmd);
221 virt = scsi_kmap_atomic_sg(scsi_sglist(cmd), scsi_sg_count(cmd),
222 &offset, &len);
223 ptr = virt + offset;
224 if (len & 1)
225 *ptr++ = inb(fd->base + REG_FIFO);
226 if (len > 1)
227 insw(fd->base + REG_FIFO, ptr, len >> 1);
228 scsi_set_resid(cmd, scsi_get_resid(cmd) - len);
229 scsi_kunmap_atomic_sg(virt);
230 }
231}
232
233static void fdomain_write_data(struct scsi_cmnd *cmd)
234{
235 struct fdomain *fd = shost_priv(cmd->device->host);
236
237 int FIFO_Size = fd->chip == tmc18c30 ? 0x800 : 0x2000;
238 unsigned char *virt, *ptr;
239 size_t offset, len;
240
241 while ((len = FIFO_Size - inw(fd->base + REG_FIFO_COUNT)) > 512) {
242 offset = scsi_bufflen(cmd) - scsi_get_resid(cmd);
243 if (len + offset > scsi_bufflen(cmd)) {
244 len = scsi_bufflen(cmd) - offset;
245 if (len == 0)
246 break;
247 }
248 virt = scsi_kmap_atomic_sg(scsi_sglist(cmd), scsi_sg_count(cmd),
249 &offset, &len);
250 ptr = virt + offset;
251 if (len & 1)
252 outb(*ptr++, fd->base + REG_FIFO);
253 if (len > 1)
254 outsw(fd->base + REG_FIFO, ptr, len >> 1);
255 scsi_set_resid(cmd, scsi_get_resid(cmd) - len);
256 scsi_kunmap_atomic_sg(virt);
257 }
258}
259
260static void fdomain_work(struct work_struct *work)
261{
262 struct fdomain *fd = container_of(work, struct fdomain, work);
263 struct Scsi_Host *sh = container_of((void *)fd, struct Scsi_Host,
264 hostdata);
265 struct scsi_cmnd *cmd = fd->cur_cmd;
266 unsigned long flags;
267 int status;
268 int done = 0;
269
270 spin_lock_irqsave(sh->host_lock, flags);
271
272 if (cmd->SCp.phase & in_arbitration) {
273 status = inb(fd->base + REG_ASTAT);
274 if (!(status & ASTAT_ARB)) {
275 set_host_byte(cmd, DID_BUS_BUSY);
276 fdomain_finish_cmd(fd);
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 set_host_byte(cmd, DID_NO_CONNECT);
294 fdomain_finish_cmd(fd);
295 goto out;
296 }
297
298 outb(ACTL_IRQEN | PARITY_MASK, fd->base + REG_ACTL);
299 }
300 cmd->SCp.phase = in_other;
301 outb(ICTL_FIFO | ICTL_REQ | FIFO_COUNT, fd->base + REG_ICTL);
302 outb(BCTL_BUSEN, fd->base + REG_BCTL);
303 goto out;
304 }
305
306
307 status = inb(fd->base + REG_BSTAT);
308
309 if (status & BSTAT_REQ) {
310 switch (status & (BSTAT_MSG | BSTAT_CMD | BSTAT_IO)) {
311 case BSTAT_CMD:
312 outb(cmd->cmnd[cmd->SCp.sent_command++],
313 fd->base + REG_SCSI_DATA);
314 break;
315 case 0:
316 if (fd->chip != tmc1800 && !cmd->SCp.have_data_in) {
317 cmd->SCp.have_data_in = -1;
318 outb(ACTL_IRQEN | ACTL_FIFOWR | ACTL_FIFOEN |
319 PARITY_MASK, fd->base + REG_ACTL);
320 }
321 break;
322 case BSTAT_IO:
323 if (fd->chip != tmc1800 && !cmd->SCp.have_data_in) {
324 cmd->SCp.have_data_in = 1;
325 outb(ACTL_IRQEN | ACTL_FIFOEN | PARITY_MASK,
326 fd->base + REG_ACTL);
327 }
328 break;
329 case BSTAT_CMD | BSTAT_IO:
330 cmd->SCp.Status = inb(fd->base + REG_SCSI_DATA);
331 break;
332 case BSTAT_MSG | BSTAT_CMD:
333 outb(MESSAGE_REJECT, fd->base + REG_SCSI_DATA);
334 break;
335 case BSTAT_MSG | BSTAT_CMD | BSTAT_IO:
336 cmd->SCp.Message = inb(fd->base + REG_SCSI_DATA);
337 if (cmd->SCp.Message == COMMAND_COMPLETE)
338 ++done;
339 break;
340 }
341 }
342
343 if (fd->chip == tmc1800 && !cmd->SCp.have_data_in &&
344 cmd->SCp.sent_command >= cmd->cmd_len) {
345 if (cmd->sc_data_direction == DMA_TO_DEVICE) {
346 cmd->SCp.have_data_in = -1;
347 outb(ACTL_IRQEN | ACTL_FIFOWR | ACTL_FIFOEN |
348 PARITY_MASK, fd->base + REG_ACTL);
349 } else {
350 cmd->SCp.have_data_in = 1;
351 outb(ACTL_IRQEN | ACTL_FIFOEN | PARITY_MASK,
352 fd->base + REG_ACTL);
353 }
354 }
355
356 if (cmd->SCp.have_data_in == -1)
357 fdomain_write_data(cmd);
358
359 if (cmd->SCp.have_data_in == 1)
360 fdomain_read_data(cmd);
361
362 if (done) {
363 set_status_byte(cmd, cmd->SCp.Status);
364 set_host_byte(cmd, DID_OK);
365 scsi_msg_to_host_byte(cmd, cmd->SCp.Message);
366 fdomain_finish_cmd(fd);
367 } else {
368 if (cmd->SCp.phase & disconnect) {
369 outb(ICTL_FIFO | ICTL_SEL | ICTL_REQ | FIFO_COUNT,
370 fd->base + REG_ICTL);
371 outb(0, fd->base + REG_BCTL);
372 } else
373 outb(ICTL_FIFO | ICTL_REQ | FIFO_COUNT,
374 fd->base + REG_ICTL);
375 }
376out:
377 spin_unlock_irqrestore(sh->host_lock, flags);
378}
379
380static irqreturn_t fdomain_irq(int irq, void *dev_id)
381{
382 struct fdomain *fd = dev_id;
383
384
385 if ((inb(fd->base + REG_ASTAT) & ASTAT_IRQ) == 0)
386 return IRQ_NONE;
387
388 outb(0, fd->base + REG_ICTL);
389
390
391 if (!fd->cur_cmd)
392 return IRQ_NONE;
393
394 schedule_work(&fd->work);
395
396 return IRQ_HANDLED;
397}
398
399static int fdomain_queue(struct Scsi_Host *sh, struct scsi_cmnd *cmd)
400{
401 struct fdomain *fd = shost_priv(cmd->device->host);
402 unsigned long flags;
403
404 cmd->SCp.Status = 0;
405 cmd->SCp.Message = 0;
406 cmd->SCp.have_data_in = 0;
407 cmd->SCp.sent_command = 0;
408 cmd->SCp.phase = in_arbitration;
409 scsi_set_resid(cmd, scsi_bufflen(cmd));
410
411 spin_lock_irqsave(sh->host_lock, flags);
412
413 fd->cur_cmd = cmd;
414
415 fdomain_make_bus_idle(fd);
416
417
418 outb(0, fd->base + REG_ICTL);
419 outb(0, fd->base + REG_BCTL);
420
421 outb(BIT(cmd->device->host->this_id), fd->base + REG_SCSI_DATA_NOACK);
422 outb(ICTL_ARB, fd->base + REG_ICTL);
423
424 outb(ACTL_ARB | ACTL_IRQEN | PARITY_MASK, fd->base + REG_ACTL);
425
426 spin_unlock_irqrestore(sh->host_lock, flags);
427
428 return 0;
429}
430
431static int fdomain_abort(struct scsi_cmnd *cmd)
432{
433 struct Scsi_Host *sh = cmd->device->host;
434 struct fdomain *fd = shost_priv(sh);
435 unsigned long flags;
436
437 if (!fd->cur_cmd)
438 return FAILED;
439
440 spin_lock_irqsave(sh->host_lock, flags);
441
442 fdomain_make_bus_idle(fd);
443 fd->cur_cmd->SCp.phase |= aborted;
444
445
446 set_host_byte(fd->cur_cmd, DID_ABORT);
447 fdomain_finish_cmd(fd);
448 spin_unlock_irqrestore(sh->host_lock, flags);
449 return SUCCESS;
450}
451
452static int fdomain_host_reset(struct scsi_cmnd *cmd)
453{
454 struct Scsi_Host *sh = cmd->device->host;
455 struct fdomain *fd = shost_priv(sh);
456 unsigned long flags;
457
458 spin_lock_irqsave(sh->host_lock, flags);
459 fdomain_reset(fd->base);
460 spin_unlock_irqrestore(sh->host_lock, flags);
461 return SUCCESS;
462}
463
464static int fdomain_biosparam(struct scsi_device *sdev,
465 struct block_device *bdev, sector_t capacity,
466 int geom[])
467{
468 unsigned char *p = scsi_bios_ptable(bdev);
469
470 if (p && p[65] == 0xaa && p[64] == 0x55
471 && p[4]) {
472 geom[0] = p[5] + 1;
473 geom[1] = p[6] & 0x3f;
474 } else {
475 if (capacity >= 0x7e0000) {
476 geom[0] = 255;
477 geom[1] = 63;
478 } else if (capacity >= 0x200000) {
479 geom[0] = 128;
480 geom[1] = 63;
481 } else {
482 geom[0] = 64;
483 geom[1] = 32;
484 }
485 }
486 geom[2] = sector_div(capacity, geom[0] * geom[1]);
487 kfree(p);
488
489 return 0;
490}
491
492static struct scsi_host_template fdomain_template = {
493 .module = THIS_MODULE,
494 .name = "Future Domain TMC-16x0",
495 .proc_name = "fdomain",
496 .queuecommand = fdomain_queue,
497 .eh_abort_handler = fdomain_abort,
498 .eh_host_reset_handler = fdomain_host_reset,
499 .bios_param = fdomain_biosparam,
500 .can_queue = 1,
501 .this_id = 7,
502 .sg_tablesize = 64,
503 .dma_boundary = PAGE_SIZE - 1,
504};
505
506struct Scsi_Host *fdomain_create(int base, int irq, int this_id,
507 struct device *dev)
508{
509 struct Scsi_Host *sh;
510 struct fdomain *fd;
511 enum chip_type chip;
512 static const char * const chip_names[] = {
513 "Unknown", "TMC-1800", "TMC-18C50", "TMC-18C30"
514 };
515 unsigned long irq_flags = 0;
516
517 chip = fdomain_identify(base);
518 if (!chip)
519 return NULL;
520
521 fdomain_reset(base);
522
523 if (fdomain_test_loopback(base))
524 return NULL;
525
526 if (!irq) {
527 dev_err(dev, "card has no IRQ assigned");
528 return NULL;
529 }
530
531 sh = scsi_host_alloc(&fdomain_template, sizeof(struct fdomain));
532 if (!sh)
533 return NULL;
534
535 if (this_id)
536 sh->this_id = this_id & 0x07;
537
538 sh->irq = irq;
539 sh->io_port = base;
540 sh->n_io_port = FDOMAIN_REGION_SIZE;
541
542 fd = shost_priv(sh);
543 fd->base = base;
544 fd->chip = chip;
545 INIT_WORK(&fd->work, fdomain_work);
546
547 if (dev_is_pci(dev) || !strcmp(dev->bus->name, "pcmcia"))
548 irq_flags = IRQF_SHARED;
549
550 if (request_irq(irq, fdomain_irq, irq_flags, "fdomain", fd))
551 goto fail_put;
552
553 shost_printk(KERN_INFO, sh, "%s chip at 0x%x irq %d SCSI ID %d\n",
554 dev_is_pci(dev) ? "TMC-36C70 (PCI bus)" : chip_names[chip],
555 base, irq, sh->this_id);
556
557 if (scsi_add_host(sh, dev))
558 goto fail_free_irq;
559
560 scsi_scan_host(sh);
561
562 return sh;
563
564fail_free_irq:
565 free_irq(irq, fd);
566fail_put:
567 scsi_host_put(sh);
568 return NULL;
569}
570EXPORT_SYMBOL_GPL(fdomain_create);
571
572int fdomain_destroy(struct Scsi_Host *sh)
573{
574 struct fdomain *fd = shost_priv(sh);
575
576 cancel_work_sync(&fd->work);
577 scsi_remove_host(sh);
578 if (sh->irq)
579 free_irq(sh->irq, fd);
580 scsi_host_put(sh);
581 return 0;
582}
583EXPORT_SYMBOL_GPL(fdomain_destroy);
584
585#ifdef CONFIG_PM_SLEEP
586static int fdomain_resume(struct device *dev)
587{
588 struct fdomain *fd = shost_priv(dev_get_drvdata(dev));
589
590 fdomain_reset(fd->base);
591 return 0;
592}
593
594static SIMPLE_DEV_PM_OPS(fdomain_pm_ops, NULL, fdomain_resume);
595#endif
596
597MODULE_AUTHOR("Ondrej Zary, Rickard E. Faith");
598MODULE_DESCRIPTION("Future Domain TMC-16x0/TMC-3260 SCSI driver");
599MODULE_LICENSE("GPL");
600