2 * Copyright (C) 1997 Wu Ching Chen
3 * 2.1.x update (C) 1998 Krzysztof G. Baranowski
4 * 2.5.x update (C) 2002 Red Hat
5 * 2.6.x update (C) 2004 Red Hat
7 * Marcelo Tosatti <marcelo@conectiva.com.br> : SMP fixes
9 * Wu Ching Chen : NULL pointer fixes 2000/06/02
11 * enable 32 bit fifo transfer
12 * support cdrom & remove device run ultra speed
13 * fix disconnect bug 2000/12/21
14 * support atp880 chip lvd u160 2001/05/15
15 * fix prd table bug 2001/09/12 (7.1)
17 * atp885 support add by ACARD Hao Ping Lian 2005/01/05
19 #include <linux/module.h>
20 #include <linux/init.h>
21 #include <linux/interrupt.h>
22 #include <linux/kernel.h>
23 #include <linux/types.h>
24 #include <linux/string.h>
25 #include <linux/ioport.h>
26 #include <linux/delay.h>
27 #include <linux/proc_fs.h>
28 #include <linux/spinlock.h>
29 #include <linux/pci.h>
30 #include <linux/blkdev.h>
31 #include <linux/dma-mapping.h>
32 #include <linux/slab.h>
33 #include <asm/system.h>
36 #include <scsi/scsi.h>
37 #include <scsi/scsi_cmnd.h>
38 #include <scsi/scsi_device.h>
39 #include <scsi/scsi_host.h>
43 static struct scsi_host_template atp870u_template;
44 static void send_s870(struct atp_unit *dev,unsigned char c);
45 static void is885(struct atp_unit *dev, unsigned int wkport,unsigned char c);
46 static void tscam_885(void);
48 static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
51 unsigned short int tmpcip, id;
52 unsigned char i, j, c, target_id, lun,cmdp;
54 struct scsi_cmnd *workreq;
55 unsigned int workport, tmport, tmport1;
56 unsigned long adrcnt, k;
61 struct Scsi_Host *host = dev_id;
62 struct atp_unit *dev = (struct atp_unit *)&host->hostdata;
64 for (c = 0; c < 2; c++) {
65 tmport = dev->ioport[c] + 0x1f;
76 printk("atp870u_intr_handle enter\n");
79 cmdp = inb(dev->ioport[c] + 0x10);
80 workport = dev->ioport[c];
81 if (dev->working[c] != 0) {
82 if (dev->dev_id == ATP885_DEVID) {
83 tmport1 = workport + 0x16;
84 if ((inb(tmport1) & 0x80) == 0)
85 outb((inb(tmport1) | 0x80), tmport1);
87 tmpcip = dev->pciport[c];
88 if ((inb(tmpcip) & 0x08) != 0)
91 for (k=0; k < 1000; k++) {
92 if ((inb(tmpcip) & 0x08) == 0) {
95 if ((inb(tmpcip) & 0x01) == 0) {
101 tmpcip = dev->pciport[c];
107 if (dev->dev_id == ATP885_DEVID) {
114 target_id = inb(tmport);
118 * Remap wide devices onto id numbers
121 if ((target_id & 0x40) != 0) {
122 target_id = (target_id & 0x07) | 0x08;
127 if ((j & 0x40) != 0) {
128 if (dev->last_cmd[c] == 0xff) {
129 dev->last_cmd[c] = target_id;
131 dev->last_cmd[c] |= 0x40;
133 if (dev->dev_id == ATP885_DEVID)
134 dev->r1f[c][target_id] |= j;
136 printk("atp870u_intr_handle status = %x\n",i);
139 if ((dev->last_cmd[c] & 0xf0) != 0x40) {
140 dev->last_cmd[c] = 0xff;
142 if (dev->dev_id == ATP885_DEVID) {
145 ((unsigned char *) &adrcnt)[2] = inb(tmport++);
146 ((unsigned char *) &adrcnt)[1] = inb(tmport++);
147 ((unsigned char *) &adrcnt)[0] = inb(tmport);
148 if (dev->id[c][target_id].last_len != adrcnt)
150 k = dev->id[c][target_id].last_len;
152 dev->id[c][target_id].tran_len = k;
153 dev->id[c][target_id].last_len = adrcnt;
156 printk("tmport = %x dev->id[c][target_id].last_len = %d dev->id[c][target_id].tran_len = %d\n",tmport,dev->id[c][target_id].last_len,dev->id[c][target_id].tran_len);
163 if (dev->wide_id[c] != 0) {
164 tmport = workport + 0x1b;
166 while ((inb(tmport) & 0x01) != 0x01) {
171 * Issue more commands
173 spin_lock_irqsave(dev->host->host_lock, flags);
174 if (((dev->quhd[c] != dev->quend[c]) || (dev->last_cmd[c] != 0xff)) &&
175 (dev->in_snd[c] == 0)) {
177 printk("Call sent_s870\n");
181 spin_unlock_irqrestore(dev->host->host_lock, flags);
187 printk("Status 0x85 return\n");
193 dev->last_cmd[c] |= 0x40;
199 if ((dev->last_cmd[c] & 0xf0) != 0x40) {
200 dev->last_cmd[c] = 0xff;
204 ((unsigned char *) &adrcnt)[2] = inb(tmport++);
205 ((unsigned char *) &adrcnt)[1] = inb(tmport++);
206 ((unsigned char *) &adrcnt)[0] = inb(tmport);
207 k = dev->id[c][target_id].last_len;
209 dev->id[c][target_id].tran_len = k;
210 dev->id[c][target_id].last_len = adrcnt;
219 if (dev->dev_id == ATP885_DEVID) {
220 if ((i == 0x4c) || (i == 0x4d) || (i == 0x8c) || (i == 0x8d)) {
221 if ((i == 0x4c) || (i == 0x8c))
228 if ((i == 0x80) || (i == 0x8f)) {
230 printk(KERN_DEBUG "Device reselect\n");
234 if (cmdp == 0x44 || i==0x80) {
236 lun = inb(tmport) & 0x07;
238 if ((dev->last_cmd[c] & 0xf0) != 0x40) {
239 dev->last_cmd[c] = 0xff;
243 printk("cmdp = 0x41\n");
247 ((unsigned char *) &adrcnt)[2] = inb(tmport++);
248 ((unsigned char *) &adrcnt)[1] = inb(tmport++);
249 ((unsigned char *) &adrcnt)[0] = inb(tmport);
250 k = dev->id[c][target_id].last_len;
252 dev->id[c][target_id].tran_len = k;
253 dev->id[c][target_id].last_len = adrcnt;
260 printk("cmdp != 0x41\n");
263 dev->id[c][target_id].dirct = 0x00;
265 outb(0x00, tmport++);
266 outb(0x00, tmport++);
267 outb(0x00, tmport++);
274 if (dev->last_cmd[c] != 0xff) {
275 dev->last_cmd[c] |= 0x40;
277 if (dev->dev_id == ATP885_DEVID) {
278 j = inb(dev->baseport + 0x29) & 0xfe;
279 outb(j, dev->baseport + 0x29);
280 tmport = workport + 0x16;
282 tmport = workport + 0x10;
287 target_id = inb(tmport);
289 * Remap wide identifiers
291 if ((target_id & 0x10) != 0) {
292 target_id = (target_id & 0x07) | 0x08;
296 if (dev->dev_id == ATP885_DEVID) {
297 tmport = workport + 0x10;
300 workreq = dev->id[c][target_id].curr_req;
302 scmd_printk(KERN_DEBUG, workreq, "CDB");
303 for (l = 0; l < workreq->cmd_len; l++)
304 printk(KERN_DEBUG " %x",workreq->cmnd[l]);
308 tmport = workport + 0x0f;
311 outb(dev->id[c][target_id].devsp, tmport++);
312 adrcnt = dev->id[c][target_id].tran_len;
313 k = dev->id[c][target_id].last_len;
315 outb(((unsigned char *) &k)[2], tmport++);
316 outb(((unsigned char *) &k)[1], tmport++);
317 outb(((unsigned char *) &k)[0], tmport++);
319 printk("k %x, k[0] 0x%x k[1] 0x%x k[2] 0x%x\n", k, inb(tmport-1), inb(tmport-2), inb(tmport-3));
324 j = (j & 0x07) | 0x40;
327 j |= dev->id[c][target_id].dirct;
331 /* enable 32 bit fifo transfer */
332 if (dev->dev_id == ATP885_DEVID) {
333 tmpcip = dev->pciport[c] + 1;
334 i=inb(tmpcip) & 0xf3;
335 //j=workreq->cmnd[0];
336 if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
340 } else if ((dev->dev_id == ATP880_DEVID1) ||
341 (dev->dev_id == ATP880_DEVID2) ) {
342 tmport = workport - 0x05;
343 if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
344 outb((unsigned char) ((inb(tmport) & 0x3f) | 0xc0), tmport);
346 outb((unsigned char) (inb(tmport) & 0x3f), tmport);
349 tmport = workport + 0x3a;
350 if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
351 outb((unsigned char) ((inb(tmport) & 0xf3) | 0x08), tmport);
353 outb((unsigned char) (inb(tmport) & 0xf3), tmport);
356 tmport = workport + 0x1b;
359 id = id << target_id;
361 * Is this a wide device
363 if ((id & dev->wide_id[c]) != 0) {
367 while ((inb(tmport) & 0x01) != j) {
370 if (dev->id[c][target_id].last_len == 0) {
371 tmport = workport + 0x18;
375 printk("dev->id[c][target_id].last_len = 0\n");
380 printk("target_id = %d adrcnt = %d\n",target_id,adrcnt);
382 prd = dev->id[c][target_id].prd_pos;
383 while (adrcnt != 0) {
384 id = ((unsigned short int *)prd)[2];
391 ((unsigned short int *)prd)[2] = (unsigned short int)
393 ((unsigned long *)prd)[0] += adrcnt;
395 dev->id[c][target_id].prd_pos = prd;
398 dev->id[c][target_id].prdaddr += 0x08;
401 dev->id[c][target_id].prd_pos = prd;
405 tmpcip = dev->pciport[c] + 0x04;
406 outl(dev->id[c][target_id].prdaddr, tmpcip);
408 printk("dev->id[%d][%d].prdaddr 0x%8x\n", c, target_id, dev->id[c][target_id].prdaddr);
410 if (dev->dev_id == ATP885_DEVID) {
418 tmport = workport + 0x18;
420 * Check transfer direction
422 if (dev->id[c][target_id].dirct != 0) {
427 printk("status 0x80 return dirct != 0\n");
435 printk("status 0x80 return dirct = 0\n");
441 * Current scsi request on this target
444 workreq = dev->id[c][target_id].curr_req;
447 if ((dev->last_cmd[c] & 0xf0) != 0x40)
449 dev->last_cmd[c] = 0xff;
452 workreq->result = errstus;
456 if ((dev->last_cmd[c] & 0xf0) != 0x40) {
457 dev->last_cmd[c] = 0xff;
461 errstus = inb(tmport);
462 if (((dev->r1f[c][target_id] & 0x10) != 0)&&(dev->dev_id==ATP885_DEVID)) {
463 printk(KERN_WARNING "AEC67162 CRC ERROR !\n");
466 workreq->result = errstus;
468 if (dev->dev_id == ATP885_DEVID) {
469 j = inb(dev->baseport + 0x29) | 0x01;
470 outb(j, dev->baseport + 0x29);
473 * Complete the command
475 scsi_dma_unmap(workreq);
477 spin_lock_irqsave(dev->host->host_lock, flags);
478 (*workreq->scsi_done) (workreq);
480 printk("workreq->scsi_done\n");
483 * Clear it off the queue
485 dev->id[c][target_id].curr_req = NULL;
487 spin_unlock_irqrestore(dev->host->host_lock, flags);
491 if (dev->wide_id[c] != 0) {
492 tmport = workport + 0x1b;
494 while ((inb(tmport) & 0x01) != 0x01) {
499 * If there is stuff to send and nothing going then send it
501 spin_lock_irqsave(dev->host->host_lock, flags);
502 if (((dev->last_cmd[c] != 0xff) || (dev->quhd[c] != dev->quend[c])) &&
503 (dev->in_snd[c] == 0)) {
505 printk("Call sent_s870(scsi_done)\n");
509 spin_unlock_irqrestore(dev->host->host_lock, flags);
513 if ((dev->last_cmd[c] & 0xf0) != 0x40) {
514 dev->last_cmd[c] = 0xff;
522 outl(dev->id[c][target_id].prdaddr, tmpcip);
527 tmport = workport + 0x10;
529 if (dev->dev_id == ATP885_DEVID) {
531 k = dev->id[c][target_id].last_len;
532 outb((unsigned char) (((unsigned char *) (&k))[2]), tmport++);
533 outb((unsigned char) (((unsigned char *) (&k))[1]), tmport++);
534 outb((unsigned char) (((unsigned char *) (&k))[0]), tmport);
535 dev->id[c][target_id].dirct = 0x00;
538 dev->id[c][target_id].dirct = 0x00;
548 outl(dev->id[c][target_id].prdaddr, tmpcip);
553 tmport = workport + 0x10;
555 if (dev->dev_id == ATP885_DEVID) {
557 k = dev->id[c][target_id].last_len;
558 outb((unsigned char) (((unsigned char *) (&k))[2]), tmport++);
559 outb((unsigned char) (((unsigned char *) (&k))[1]), tmport++);
560 outb((unsigned char) (((unsigned char *) (&k))[0]), tmport++);
564 outb((unsigned char) (inb(tmport) | 0x20), tmport);
565 dev->id[c][target_id].dirct = 0x20;
578 dev->id[c][target_id].dirct = 0x00;
580 outb(0x00, tmport++);
581 outb(0x00, tmport++);
582 outb(0x00, tmport++);
588 // tmport = workport + 0x17;
590 // dev->working[c] = 0;
597 printk("atp870u_intr_handle exit\n");
602 * atp870u_queuecommand - Queue SCSI command
603 * @req_p: request block
604 * @done: completion function
606 * Queue a command to the ATP queue. Called with the host lock held.
608 static int atp870u_queuecommand(struct scsi_cmnd * req_p,
609 void (*done) (struct scsi_cmnd *))
612 unsigned int tmport,m;
613 struct atp_unit *dev;
614 struct Scsi_Host *host;
616 c = scmd_channel(req_p);
617 req_p->sense_buffer[0]=0;
618 scsi_set_resid(req_p, 0);
619 if (scmd_channel(req_p) > 1) {
620 req_p->result = 0x00040000;
623 printk("atp870u_queuecommand : req_p->device->channel > 1\n");
628 host = req_p->device->host;
629 dev = (struct atp_unit *)&host->hostdata;
634 m = m << scmd_id(req_p);
637 * Fake a timeout for missing targets
640 if ((m & dev->active_id[c]) == 0) {
641 req_p->result = 0x00040000;
647 req_p->scsi_done = done;
650 printk( "atp870u_queuecommand: done can't be NULL\n");
661 if (dev->quend[c] >= qcnt) {
668 if (dev->quhd[c] == dev->quend[c]) {
669 if (dev->quend[c] == 0) {
670 dev->quend[c] = qcnt;
673 printk("atp870u_queuecommand : dev->quhd[c] == dev->quend[c]\n");
676 req_p->result = 0x00020000;
680 dev->quereq[c][dev->quend[c]] = req_p;
681 tmport = dev->ioport[c] + 0x1c;
683 printk("dev->ioport[c] = %x inb(tmport) = %x dev->in_int[%d] = %d dev->in_snd[%d] = %d\n",dev->ioport[c],inb(tmport),c,dev->in_int[c],c,dev->in_snd[c]);
685 if ((inb(tmport) == 0) && (dev->in_int[c] == 0) && (dev->in_snd[c] == 0)) {
687 printk("Call sent_s870(atp870u_queuecommand)\n");
692 printk("atp870u_queuecommand : exit\n");
698 * send_s870 - send a command to the controller
701 * On entry there is work queued to be done. We move some of that work to the
704 * Caller holds the host lock.
706 static void send_s870(struct atp_unit *dev,unsigned char c)
709 struct scsi_cmnd *workreq;
711 unsigned char j, target_id;
713 unsigned short int tmpcip, w;
714 unsigned long l, bttl = 0;
715 unsigned int workport;
716 unsigned long sg_count;
718 if (dev->in_snd[c] != 0) {
720 printk("cmnd in_snd\n");
725 printk("Sent_s870 enter\n");
728 if ((dev->last_cmd[c] != 0xff) && ((dev->last_cmd[c] & 0x40) != 0)) {
729 dev->last_cmd[c] &= 0x0f;
730 workreq = dev->id[c][dev->last_cmd[c]].curr_req;
731 if (workreq != NULL) { /* check NULL pointer */
734 dev->last_cmd[c] = 0xff;
735 if (dev->quhd[c] == dev->quend[c]) {
740 if ((dev->last_cmd[c] != 0xff) && (dev->working[c] != 0)) {
747 if (dev->quhd[c] >= qcnt) {
750 workreq = dev->quereq[c][dev->quhd[c]];
751 if (dev->id[c][scmd_id(workreq)].curr_req == NULL) {
752 dev->id[c][scmd_id(workreq)].curr_req = workreq;
753 dev->last_cmd[c] = scmd_id(workreq);
761 workport = dev->ioport[c];
762 tmport = workport + 0x1f;
763 if ((inb(tmport) & 0xb0) != 0) {
766 tmport = workport + 0x1c;
767 if (inb(tmport) == 0) {
772 printk("Abort to Send\n");
774 dev->last_cmd[c] |= 0x40;
779 printk("OK to Send\n");
780 scmd_printk(KERN_DEBUG, workreq, "CDB");
781 for(i=0;i<workreq->cmd_len;i++) {
782 printk(" %x",workreq->cmnd[i]);
786 l = scsi_bufflen(workreq);
788 if (dev->dev_id == ATP885_DEVID) {
789 j = inb(dev->baseport + 0x29) & 0xfe;
790 outb(j, dev->baseport + 0x29);
791 dev->r1f[c][scmd_id(workreq)] = 0;
794 if (workreq->cmnd[0] == READ_CAPACITY) {
798 if (workreq->cmnd[0] == 0x00) {
802 tmport = workport + 0x1b;
804 target_id = scmd_id(workreq);
811 if ((w & dev->wide_id[c]) != 0) {
815 while ((inb(tmport) & 0x01) != j) {
818 printk("send_s870 while loop 1\n");
826 outb(workreq->cmd_len, tmport++);
827 outb(0x2c, tmport++);
828 if (dev->dev_id == ATP885_DEVID) {
829 outb(0x7f, tmport++);
831 outb(0xcf, tmport++);
833 for (i = 0; i < workreq->cmd_len; i++) {
834 outb(workreq->cmnd[i], tmport++);
836 tmport = workport + 0x0f;
837 outb(workreq->device->lun, tmport);
842 outb(dev->id[c][target_id].devsp, tmport++);
844 printk("dev->id[%d][%d].devsp = %2x\n",c,target_id,dev->id[c][target_id].devsp);
847 sg_count = scsi_dma_map(workreq);
849 * Write transfer size
851 outb((unsigned char) (((unsigned char *) (&l))[2]), tmport++);
852 outb((unsigned char) (((unsigned char *) (&l))[1]), tmport++);
853 outb((unsigned char) (((unsigned char *) (&l))[0]), tmport++);
855 dev->id[c][j].last_len = l;
856 dev->id[c][j].tran_len = 0;
858 printk("dev->id[%2d][%2d].last_len = %d\n",c,j,dev->id[c][j].last_len);
863 if ((j & 0x08) != 0) {
864 j = (j & 0x07) | 0x40;
867 * Check transfer direction
869 if (workreq->sc_data_direction == DMA_TO_DEVICE) {
870 outb((unsigned char) (j | 0x20), tmport++);
874 outb((unsigned char) (inb(tmport) | 0x80), tmport);
876 tmport = workport + 0x1c;
877 dev->id[c][target_id].dirct = 0;
879 if (inb(tmport) == 0) {
880 tmport = workport + 0x18;
882 printk("change SCSI_CMD_REG 0x08\n");
886 dev->last_cmd[c] |= 0x40;
891 tmpcip = dev->pciport[c];
892 prd = dev->id[c][target_id].prd_table;
893 dev->id[c][target_id].prd_pos = prd;
896 * Now write the request list. Either as scatter/gather or as
901 struct scatterlist *sgpnt;
903 scsi_for_each_sg(workreq, sgpnt, sg_count, j) {
904 bttl = sg_dma_address(sgpnt);
907 printk("1. bttl %x, l %x\n",bttl, l);
909 while (l > 0x10000) {
910 (((u16 *) (prd))[i + 3]) = 0x0000;
911 (((u16 *) (prd))[i + 2]) = 0x0000;
912 (((u32 *) (prd))[i >> 1]) = cpu_to_le32(bttl);
917 (((u32 *) (prd))[i >> 1]) = cpu_to_le32(bttl);
918 (((u16 *) (prd))[i + 2]) = cpu_to_le16(l);
919 (((u16 *) (prd))[i + 3]) = 0;
922 (((u16 *) (prd))[i - 1]) = cpu_to_le16(0x8000);
924 printk("prd %4x %4x %4x %4x\n",(((unsigned short int *)prd)[0]),(((unsigned short int *)prd)[1]),(((unsigned short int *)prd)[2]),(((unsigned short int *)prd)[3]));
925 printk("2. bttl %x, l %x\n",bttl, l);
930 printk("send_s870: prdaddr_2 0x%8x tmpcip %x target_id %d\n", dev->id[c][target_id].prdaddr,tmpcip,target_id);
932 dev->id[c][target_id].prdaddr = dev->id[c][target_id].prd_bus;
933 outl(dev->id[c][target_id].prdaddr, tmpcip);
937 if (dev->dev_id == ATP885_DEVID) {
939 j=inb(tmpcip) & 0xf3;
940 if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) ||
941 (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
946 } else if ((dev->dev_id == ATP880_DEVID1) ||
947 (dev->dev_id == ATP880_DEVID2)) {
949 tmport = workport - 0x05;
950 if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
951 outb((unsigned char) ((inb(tmport) & 0x3f) | 0xc0), tmport);
953 outb((unsigned char) (inb(tmport) & 0x3f), tmport);
957 tmport = workport + 0x3a;
958 if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
959 outb((inb(tmport) & 0xf3) | 0x08, tmport);
961 outb(inb(tmport) & 0xf3, tmport);
964 tmport = workport + 0x1c;
966 if(workreq->sc_data_direction == DMA_TO_DEVICE) {
967 dev->id[c][target_id].dirct = 0x20;
968 if (inb(tmport) == 0) {
969 tmport = workport + 0x18;
973 printk( "start DMA(to target)\n");
976 dev->last_cmd[c] |= 0x40;
981 if (inb(tmport) == 0) {
982 tmport = workport + 0x18;
986 printk( "start DMA(to host)\n");
989 dev->last_cmd[c] |= 0x40;
996 static unsigned char fun_scam(struct atp_unit *dev, unsigned short int *val)
999 unsigned short int i, k;
1002 tmport = dev->ioport[0] + 0x1c;
1005 for (i = 0; i < 10; i++) { /* stable >= bus settle delay(400 ns) */
1007 j = (unsigned char) (k >> 8);
1008 if ((k & 0x8000) != 0) { /* DB7 all release? */
1012 *val |= 0x4000; /* assert DB6 */
1014 *val &= 0xdfff; /* assert DB5 */
1017 for (i = 0; i < 10; i++) { /* stable >= bus settle delay(400 ns) */
1018 if ((inw(tmport) & 0x2000) != 0) { /* DB5 all release? */
1022 *val |= 0x8000; /* no DB4-0, assert DB7 */
1025 *val &= 0xbfff; /* release DB6 */
1028 for (i = 0; i < 10; i++) { /* stable >= bus settle delay(400 ns) */
1029 if ((inw(tmport) & 0x4000) != 0) { /* DB6 all release? */
1037 static void tscam(struct Scsi_Host *host)
1040 unsigned int tmport;
1041 unsigned char i, j, k;
1043 unsigned short int m, assignid_map, val;
1044 unsigned char mbuf[33], quintet[2];
1045 struct atp_unit *dev = (struct atp_unit *)&host->hostdata;
1046 static unsigned char g2q_tab[8] = {
1047 0x38, 0x31, 0x32, 0x2b, 0x34, 0x2d, 0x2e, 0x27
1050 /* I can't believe we need this before we've even done anything. Remove it
1051 * and see if anyone bitches.
1052 for (i = 0; i < 0x10; i++) {
1057 tmport = dev->ioport[0] + 1;
1058 outb(0x08, tmport++);
1060 tmport = dev->ioport[0] + 0x11;
1063 if ((dev->scam_on & 0x40) == 0) {
1067 m <<= dev->host_id[0];
1069 if (dev->chip_ver < 4) {
1074 tmport = dev->ioport[0] + 0x02;
1075 outb(0x02, tmport++); /* 2*2=4ms,3EH 2/32*3E=3.9ms */
1083 for (i = 0; i < j; i++) {
1086 if ((m & assignid_map) != 0) {
1089 tmport = dev->ioport[0] + 0x0f;
1096 k = (i & 0x07) | 0x40;
1101 tmport = dev->ioport[0] + 0x1b;
1102 if (dev->chip_ver == 4) {
1108 tmport = dev->ioport[0] + 0x18;
1112 while ((inb(tmport) & 0x80) == 0x00)
1117 if ((k == 0x85) || (k == 0x42)) {
1120 tmport = dev->ioport[0] + 0x10;
1127 tmport = dev->ioport[0] + 0x02;
1129 tmport = dev->ioport[0] + 0x1b;
1134 val = 0x0080; /* bsy */
1135 tmport = dev->ioport[0] + 0x1c;
1137 val |= 0x0040; /* sel */
1139 val |= 0x0004; /* msg */
1141 inb(0x80); /* 2 deskew delay(45ns*2=90ns) */
1142 val &= 0x007f; /* no bsy */
1145 val &= 0x00fb; /* after 1ms no msg */
1148 if ((inb(tmport) & 0x04) != 0) {
1153 for (n = 0; n < 0x30000; n++) {
1154 if ((inb(tmport) & 0x80) != 0) { /* bsy ? */
1160 for (n = 0; n < 0x30000; n++) {
1161 if ((inb(tmport) & 0x81) == 0x0081) {
1168 val |= 0x8003; /* io,cd,db7 */
1171 val &= 0x00bf; /* no sel */
1176 if ((inb(tmport) & 0x80) == 0x00) { /* bsy ? */
1179 tmport = dev->ioport[0] + 0x15;
1184 while ((inb(tmport) & 0x80) == 0)
1190 val &= 0x00ff; /* synchronization */
1192 fun_scam(dev, &val);
1194 val &= 0x00ff; /* isolation */
1196 fun_scam(dev, &val);
1201 if ((inw(tmport) & 0x2000) == 0) {
1205 val &= 0x00ff; /* get ID_STRING */
1207 k = fun_scam(dev, &val);
1208 if ((k & 0x03) == 0) {
1213 if ((k & 0x02) != 0) {
1224 TCM_5: /* isolation complete.. */
1226 printk(" \n%x %x %x %s\n ",assignid_map,mbuf[0],mbuf[1],&mbuf[2]); */
1229 if ((j & 0x20) != 0) { /* bit5=1:ID upto 7 */
1232 if ((j & 0x06) == 0) { /* IDvalid? */
1239 if ((m & assignid_map) == 0) {
1246 G2Q5: /* srch from max acceptable ID# */
1247 k = i; /* max acceptable ID# */
1251 if ((m & assignid_map) == 0) {
1258 G2Q_QUIN: /* k=binID#, */
1261 quintet[0] = 0x38; /* 1st dft ID<8 */
1263 quintet[0] = 0x31; /* 1st ID>=8 */
1266 quintet[1] = g2q_tab[k];
1268 val &= 0x00ff; /* AssignID 1stQuintet,AH=001xxxxx */
1269 m = quintet[0] << 8;
1271 fun_scam(dev, &val);
1272 val &= 0x00ff; /* AssignID 2ndQuintet,AH=001xxxxx */
1273 m = quintet[1] << 8;
1275 fun_scam(dev, &val);
1281 static void is870(struct atp_unit *dev, unsigned int wkport)
1283 unsigned int tmport;
1284 unsigned char i, j, k, rmb, n;
1285 unsigned short int m;
1286 static unsigned char mbuf[512];
1287 static unsigned char satn[9] = { 0, 0, 0, 0, 0, 0, 0, 6, 6 };
1288 static unsigned char inqd[9] = { 0x12, 0, 0, 0, 0x24, 0, 0, 0x24, 6 };
1289 static unsigned char synn[6] = { 0x80, 1, 3, 1, 0x19, 0x0e };
1290 static unsigned char synu[6] = { 0x80, 1, 3, 1, 0x0c, 0x0e };
1291 static unsigned char synw[6] = { 0x80, 1, 3, 1, 0x0c, 0x07 };
1292 static unsigned char wide[6] = { 0x80, 1, 2, 3, 1, 0 };
1294 tmport = wkport + 0x3a;
1295 outb((unsigned char) (inb(tmport) | 0x10), tmport);
1297 for (i = 0; i < 16; i++) {
1298 if ((dev->chip_ver != 4) && (i > 7)) {
1303 if ((m & dev->active_id[0]) != 0) {
1306 if (i == dev->host_id[0]) {
1307 printk(KERN_INFO " ID: %2d Host Adapter\n", dev->host_id[0]);
1310 tmport = wkport + 0x1b;
1311 if (dev->chip_ver == 4) {
1316 tmport = wkport + 1;
1317 outb(0x08, tmport++);
1318 outb(0x7f, tmport++);
1319 outb(satn[0], tmport++);
1320 outb(satn[1], tmport++);
1321 outb(satn[2], tmport++);
1322 outb(satn[3], tmport++);
1323 outb(satn[4], tmport++);
1324 outb(satn[5], tmport++);
1328 outb(dev->id[0][i].devsp, tmport++);
1330 outb(satn[6], tmport++);
1331 outb(satn[7], tmport++);
1333 if ((j & 0x08) != 0) {
1334 j = (j & 0x07) | 0x40;
1338 outb(satn[8], tmport);
1341 while ((inb(tmport) & 0x80) == 0x00)
1345 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
1348 while (inb(tmport) != 0x8e)
1351 dev->active_id[0] |= m;
1353 tmport = wkport + 0x10;
1355 tmport = wkport + 0x04;
1359 tmport = wkport + 0x18;
1362 while ((inb(tmport) & 0x80) == 0x00)
1367 tmport = wkport + 0x10;
1372 tmport = wkport + 3;
1373 outb(inqd[0], tmport++);
1374 outb(inqd[1], tmport++);
1375 outb(inqd[2], tmport++);
1376 outb(inqd[3], tmport++);
1377 outb(inqd[4], tmport++);
1378 outb(inqd[5], tmport);
1382 outb(dev->id[0][i].devsp, tmport++);
1384 outb(inqd[6], tmport++);
1385 outb(inqd[7], tmport++);
1387 outb(inqd[8], tmport);
1390 while ((inb(tmport) & 0x80) == 0x00)
1394 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
1397 while (inb(tmport) != 0x8e)
1400 tmport = wkport + 0x1b;
1401 if (dev->chip_ver == 4)
1404 tmport = wkport + 0x18;
1410 if ((k & 0x01) != 0) {
1412 mbuf[j++] = inb(tmport);
1416 if ((k & 0x80) == 0) {
1424 tmport = wkport + 0x10;
1434 while ((inb(tmport) & 0x80) == 0x00)
1438 if (inb(tmport) != 0x16) {
1443 printk(KERN_INFO " ID: %2d %s\n", i, &mbuf[8]);
1444 dev->id[0][i].devtype = mbuf[0];
1447 if (dev->chip_ver != 4) {
1450 if ((mbuf[7] & 0x60) == 0) {
1453 if ((dev->global_map[0] & 0x20) == 0) {
1456 tmport = wkport + 0x1b;
1458 tmport = wkport + 3;
1459 outb(satn[0], tmport++);
1460 outb(satn[1], tmport++);
1461 outb(satn[2], tmport++);
1462 outb(satn[3], tmport++);
1463 outb(satn[4], tmport++);
1464 outb(satn[5], tmport++);
1468 outb(dev->id[0][i].devsp, tmport++);
1470 outb(satn[6], tmport++);
1471 outb(satn[7], tmport++);
1473 outb(satn[8], tmport);
1476 while ((inb(tmport) & 0x80) == 0x00)
1480 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
1483 while (inb(tmport) != 0x8e)
1488 tmport = wkport + 0x14;
1494 while ((inb(tmport) & 0x80) == 0) {
1495 if ((inb(tmport) & 0x01) != 0) {
1497 outb(wide[j++], tmport);
1503 while ((inb(tmport) & 0x80) == 0x00)
1506 j = inb(tmport) & 0x0f;
1518 tmport = wkport + 0x18;
1521 while ((inb(tmport) & 0x80) == 0) {
1522 if ((inb(tmport) & 0x01) != 0) {
1529 j = inb(tmport) & 0x0f;
1541 tmport = wkport + 0x14;
1549 if ((j & 0x01) != 0) {
1551 mbuf[k++] = inb(tmport);
1555 if ((j & 0x80) == 0x00) {
1559 j = inb(tmport) & 0x0f;
1571 tmport = wkport + 0x10;
1573 tmport = wkport + 0x14;
1579 while ((inb(tmport) & 0x80) == 0x00)
1590 if (mbuf[0] != 0x01) {
1593 if (mbuf[1] != 0x02) {
1596 if (mbuf[2] != 0x03) {
1599 if (mbuf[3] != 0x01) {
1604 dev->wide_id[0] |= m;
1606 if ((dev->id[0][i].devtype == 0x00) || (dev->id[0][i].devtype == 0x07) || ((dev->id[0][i].devtype == 0x05) && ((n & 0x10) != 0))) {
1611 tmport = wkport + 0x1b;
1613 if ((m & dev->wide_id[0]) != 0) {
1617 tmport = wkport + 3;
1618 outb(satn[0], tmport++);
1619 outb(satn[1], tmport++);
1620 outb(satn[2], tmport++);
1621 outb(satn[3], tmport++);
1622 outb(satn[4], tmport++);
1623 outb(satn[5], tmport++);
1627 outb(dev->id[0][i].devsp, tmport++);
1629 outb(satn[6], tmport++);
1630 outb(satn[7], tmport++);
1632 outb(satn[8], tmport);
1635 while ((inb(tmport) & 0x80) == 0x00)
1639 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
1642 while (inb(tmport) != 0x8e)
1647 tmport = wkport + 0x14;
1653 while ((inb(tmport) & 0x80) == 0) {
1654 if ((inb(tmport) & 0x01) != 0) {
1656 if ((m & dev->wide_id[0]) != 0) {
1657 outb(synw[j++], tmport);
1659 if ((m & dev->ultra_map[0]) != 0) {
1660 outb(synu[j++], tmport);
1662 outb(synn[j++], tmport);
1670 while ((inb(tmport) & 0x80) == 0x00)
1673 j = inb(tmport) & 0x0f;
1685 tmport = wkport + 0x18;
1688 while ((inb(tmport) & 0x80) == 0x00) {
1689 if ((inb(tmport) & 0x01) != 0x00) {
1712 tmport = wkport + 0x14;
1720 if ((j & 0x01) != 0x00) {
1722 mbuf[k++] = inb(tmport);
1726 if ((j & 0x80) == 0x00) {
1731 while ((inb(tmport) & 0x80) == 0x00)
1750 tmport = wkport + 0x10;
1753 tmport = wkport + 0x14;
1759 while ((inb(tmport) & 0x80) == 0x00)
1767 if (mbuf[0] != 0x01) {
1770 if (mbuf[1] != 0x03) {
1773 if (mbuf[4] == 0x00) {
1776 if (mbuf[3] > 0x64) {
1779 if (mbuf[4] > 0x0c) {
1782 dev->id[0][i].devsp = mbuf[4];
1783 if ((mbuf[3] < 0x0d) && (rmb == 0)) {
1787 if (mbuf[3] < 0x1a) {
1791 if (mbuf[3] < 0x33) {
1795 if (mbuf[3] < 0x4c) {
1801 dev->id[0][i].devsp = (dev->id[0][i].devsp & 0x0f) | j;
1803 tmport = wkport + 0x3a;
1804 outb((unsigned char) (inb(tmport) & 0xef), tmport);
1807 static void is880(struct atp_unit *dev, unsigned int wkport)
1809 unsigned int tmport;
1810 unsigned char i, j, k, rmb, n, lvdmode;
1811 unsigned short int m;
1812 static unsigned char mbuf[512];
1813 static unsigned char satn[9] = { 0, 0, 0, 0, 0, 0, 0, 6, 6 };
1814 static unsigned char inqd[9] = { 0x12, 0, 0, 0, 0x24, 0, 0, 0x24, 6 };
1815 static unsigned char synn[6] = { 0x80, 1, 3, 1, 0x19, 0x0e };
1816 unsigned char synu[6] = { 0x80, 1, 3, 1, 0x0a, 0x0e };
1817 static unsigned char synw[6] = { 0x80, 1, 3, 1, 0x19, 0x0e };
1818 unsigned char synuw[6] = { 0x80, 1, 3, 1, 0x0a, 0x0e };
1819 static unsigned char wide[6] = { 0x80, 1, 2, 3, 1, 0 };
1820 static unsigned char u3[9] = { 0x80, 1, 6, 4, 0x09, 00, 0x0e, 0x01, 0x02 };
1822 lvdmode = inb(wkport + 0x3f) & 0x40;
1824 for (i = 0; i < 16; i++) {
1827 if ((m & dev->active_id[0]) != 0) {
1830 if (i == dev->host_id[0]) {
1831 printk(KERN_INFO " ID: %2d Host Adapter\n", dev->host_id[0]);
1834 tmport = wkport + 0x5b;
1836 tmport = wkport + 0x41;
1837 outb(0x08, tmport++);
1838 outb(0x7f, tmport++);
1839 outb(satn[0], tmport++);
1840 outb(satn[1], tmport++);
1841 outb(satn[2], tmport++);
1842 outb(satn[3], tmport++);
1843 outb(satn[4], tmport++);
1844 outb(satn[5], tmport++);
1848 outb(dev->id[0][i].devsp, tmport++);
1850 outb(satn[6], tmport++);
1851 outb(satn[7], tmport++);
1853 if ((j & 0x08) != 0) {
1854 j = (j & 0x07) | 0x40;
1858 outb(satn[8], tmport);
1861 while ((inb(tmport) & 0x80) == 0x00)
1865 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
1868 while (inb(tmport) != 0x8e)
1871 dev->active_id[0] |= m;
1873 tmport = wkport + 0x50;
1875 tmport = wkport + 0x54;
1879 tmport = wkport + 0x58;
1883 while ((inb(tmport) & 0x80) == 0x00)
1889 tmport = wkport + 0x50;
1894 tmport = wkport + 0x43;
1895 outb(inqd[0], tmport++);
1896 outb(inqd[1], tmport++);
1897 outb(inqd[2], tmport++);
1898 outb(inqd[3], tmport++);
1899 outb(inqd[4], tmport++);
1900 outb(inqd[5], tmport);
1904 outb(dev->id[0][i].devsp, tmport++);
1906 outb(inqd[6], tmport++);
1907 outb(inqd[7], tmport++);
1909 outb(inqd[8], tmport);
1912 while ((inb(tmport) & 0x80) == 0x00)
1916 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
1919 while (inb(tmport) != 0x8e)
1922 tmport = wkport + 0x5b;
1924 tmport = wkport + 0x58;
1930 if ((k & 0x01) != 0) {
1932 mbuf[j++] = inb(tmport);
1936 if ((k & 0x80) == 0) {
1944 tmport = wkport + 0x50;
1953 while ((inb(tmport) & 0x80) == 0x00)
1957 if (inb(tmport) != 0x16)
1962 printk(KERN_INFO " ID: %2d %s\n", i, &mbuf[8]);
1963 dev->id[0][i].devtype = mbuf[0];
1966 if ((mbuf[7] & 0x60) == 0) {
1969 if ((i < 8) && ((dev->global_map[0] & 0x20) == 0)) {
1975 if (dev->sp[0][i] != 0x04) // force u2
1980 tmport = wkport + 0x5b;
1982 tmport = wkport + 0x43;
1983 outb(satn[0], tmport++);
1984 outb(satn[1], tmport++);
1985 outb(satn[2], tmport++);
1986 outb(satn[3], tmport++);
1987 outb(satn[4], tmport++);
1988 outb(satn[5], tmport++);
1992 outb(dev->id[0][i].devsp, tmport++);
1994 outb(satn[6], tmport++);
1995 outb(satn[7], tmport++);
1997 outb(satn[8], tmport);
2000 while ((inb(tmport) & 0x80) == 0x00)
2005 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
2008 while (inb(tmport) != 0x8e)
2013 tmport = wkport + 0x54;
2019 while ((inb(tmport) & 0x80) == 0) {
2020 if ((inb(tmport) & 0x01) != 0) {
2022 outb(u3[j++], tmport);
2028 while ((inb(tmport) & 0x80) == 0x00)
2031 j = inb(tmport) & 0x0f;
2043 tmport = wkport + 0x58;
2046 while ((inb(tmport) & 0x80) == 0) {
2047 if ((inb(tmport) & 0x01) != 0) {
2054 j = inb(tmport) & 0x0f;
2066 tmport = wkport + 0x54;
2074 if ((j & 0x01) != 0) {
2076 mbuf[k++] = inb(tmport);
2080 if ((j & 0x80) == 0x00) {
2084 j = inb(tmport) & 0x0f;
2096 tmport = wkport + 0x50;
2098 tmport = wkport + 0x54;
2104 while ((inb(tmport) & 0x80) == 0x00)
2115 if (mbuf[0] != 0x01) {
2118 if (mbuf[1] != 0x06) {
2121 if (mbuf[2] != 0x04) {
2124 if (mbuf[3] == 0x09) {
2127 dev->wide_id[0] |= m;
2128 dev->id[0][i].devsp = 0xce;
2132 tmport = wkport + 0x5b;
2134 tmport = wkport + 0x43;
2135 outb(satn[0], tmport++);
2136 outb(satn[1], tmport++);
2137 outb(satn[2], tmport++);
2138 outb(satn[3], tmport++);
2139 outb(satn[4], tmport++);
2140 outb(satn[5], tmport++);
2144 outb(dev->id[0][i].devsp, tmport++);
2146 outb(satn[6], tmport++);
2147 outb(satn[7], tmport++);
2149 outb(satn[8], tmport);
2152 while ((inb(tmport) & 0x80) == 0x00)
2156 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
2159 while (inb(tmport) != 0x8e)
2164 tmport = wkport + 0x54;
2170 while ((inb(tmport) & 0x80) == 0) {
2171 if ((inb(tmport) & 0x01) != 0) {
2173 outb(wide[j++], tmport);
2178 while ((inb(tmport) & 0x80) == 0x00)
2181 j = inb(tmport) & 0x0f;
2193 tmport = wkport + 0x58;
2196 while ((inb(tmport) & 0x80) == 0) {
2197 if ((inb(tmport) & 0x01) != 0) {
2204 j = inb(tmport) & 0x0f;
2216 tmport = wkport + 0x54;
2224 if ((j & 0x01) != 0) {
2226 mbuf[k++] = inb(tmport);
2230 if ((j & 0x80) == 0x00) {
2234 j = inb(tmport) & 0x0f;
2246 tmport = wkport + 0x50;
2248 tmport = wkport + 0x54;
2254 while ((inb(tmport) & 0x80) == 0x00)
2265 if (mbuf[0] != 0x01) {
2268 if (mbuf[1] != 0x02) {
2271 if (mbuf[2] != 0x03) {
2274 if (mbuf[3] != 0x01) {
2279 dev->wide_id[0] |= m;
2281 if ((dev->id[0][i].devtype == 0x00) || (dev->id[0][i].devtype == 0x07) || ((dev->id[0][i].devtype == 0x05) && ((n & 0x10) != 0))) {
2284 if ((dev->async[0] & m) != 0) {
2290 if (dev->sp[0][i] == 0x02) {
2294 if (dev->sp[0][i] >= 0x03) {
2299 tmport = wkport + 0x5b;
2301 if ((m & dev->wide_id[0]) != 0) {
2305 tmport = wkport + 0x43;
2306 outb(satn[0], tmport++);
2307 outb(satn[1], tmport++);
2308 outb(satn[2], tmport++);
2309 outb(satn[3], tmport++);
2310 outb(satn[4], tmport++);
2311 outb(satn[5], tmport++);
2315 outb(dev->id[0][i].devsp, tmport++);
2317 outb(satn[6], tmport++);
2318 outb(satn[7], tmport++);
2320 outb(satn[8], tmport);
2323 while ((inb(tmport) & 0x80) == 0x00)
2327 if ((inb(tmport) != 0x11) && (inb(tmport) != 0x8e)) {
2330 while (inb(tmport) != 0x8e)
2335 tmport = wkport + 0x54;
2341 while ((inb(tmport) & 0x80) == 0) {
2342 if ((inb(tmport) & 0x01) != 0) {
2344 if ((m & dev->wide_id[0]) != 0) {
2345 if ((m & dev->ultra_map[0]) != 0) {
2346 outb(synuw[j++], tmport);
2348 outb(synw[j++], tmport);
2351 if ((m & dev->ultra_map[0]) != 0) {
2352 outb(synu[j++], tmport);
2354 outb(synn[j++], tmport);
2362 while ((inb(tmport) & 0x80) == 0x00)
2365 j = inb(tmport) & 0x0f;
2377 tmport = wkport + 0x58;
2380 while ((inb(tmport) & 0x80) == 0x00) {
2381 if ((inb(tmport) & 0x01) != 0x00) {
2404 tmport = wkport + 0x54;
2412 if ((j & 0x01) != 0x00) {
2414 mbuf[k++] = inb(tmport);
2418 if ((j & 0x80) == 0x00) {
2423 while ((inb(tmport) & 0x80) == 0x00)
2442 tmport = wkport + 0x50;
2445 tmport = wkport + 0x54;
2451 while ((inb(tmport) & 0x80) == 0x00)
2459 if (mbuf[0] != 0x01) {
2462 if (mbuf[1] != 0x03) {
2465 if (mbuf[4] == 0x00) {
2468 if (mbuf[3] > 0x64) {
2471 if (mbuf[4] > 0x0e) {
2474 dev->id[0][i].devsp = mbuf[4];
2475 if (mbuf[3] < 0x0c) {
2479 if ((mbuf[3] < 0x0d) && (rmb == 0)) {
2483 if (mbuf[3] < 0x1a) {
2487 if (mbuf[3] < 0x33) {
2491 if (mbuf[3] < 0x4c) {
2497 dev->id[0][i].devsp = (dev->id[0][i].devsp & 0x0f) | j;
2501 static void atp870u_free_tables(struct Scsi_Host *host)
2503 struct atp_unit *atp_dev = (struct atp_unit *)&host->hostdata;
2505 for (j=0; j < 2; j++) {
2506 for (k = 0; k < 16; k++) {
2507 if (!atp_dev->id[j][k].prd_table)
2509 pci_free_consistent(atp_dev->pdev, 1024, atp_dev->id[j][k].prd_table, atp_dev->id[j][k].prd_bus);
2510 atp_dev->id[j][k].prd_table = NULL;
2515 static int atp870u_init_tables(struct Scsi_Host *host)
2517 struct atp_unit *atp_dev = (struct atp_unit *)&host->hostdata;
2519 for(c=0;c < 2;c++) {
2521 atp_dev->id[c][k].prd_table = pci_alloc_consistent(atp_dev->pdev, 1024, &(atp_dev->id[c][k].prd_bus));
2522 if (!atp_dev->id[c][k].prd_table) {
2523 printk("atp870u_init_tables fail\n");
2524 atp870u_free_tables(host);
2527 atp_dev->id[c][k].prdaddr = atp_dev->id[c][k].prd_bus;
2528 atp_dev->id[c][k].devsp=0x20;
2529 atp_dev->id[c][k].devtype = 0x7f;
2530 atp_dev->id[c][k].curr_req = NULL;
2533 atp_dev->active_id[c] = 0;
2534 atp_dev->wide_id[c] = 0;
2535 atp_dev->host_id[c] = 0x07;
2536 atp_dev->quhd[c] = 0;
2537 atp_dev->quend[c] = 0;
2538 atp_dev->last_cmd[c] = 0xff;
2539 atp_dev->in_snd[c] = 0;
2540 atp_dev->in_int[c] = 0;
2542 for (k = 0; k < qcnt; k++) {
2543 atp_dev->quereq[c][k] = NULL;
2545 for (k = 0; k < 16; k++) {
2546 atp_dev->id[c][k].curr_req = NULL;
2547 atp_dev->sp[c][k] = 0x04;
2553 /* return non-zero on detection */
2554 static int atp870u_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
2556 unsigned char k, m, c;
2557 unsigned long flags;
2558 unsigned int base_io, tmport, error,n;
2559 unsigned char host_id;
2560 struct Scsi_Host *shpnt = NULL;
2561 struct atp_unit *atpdev, *p;
2562 unsigned char setupdata[2][16];
2565 atpdev = kzalloc(sizeof(*atpdev), GFP_KERNEL);
2569 if (pci_enable_device(pdev))
2572 if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32))) {
2573 printk(KERN_INFO "atp870u: use 32bit DMA mask.\n");
2575 printk(KERN_ERR "atp870u: DMA mask required but not available.\n");
2580 * It's probably easier to weed out some revisions like
2581 * this than via the PCI device table
2583 if (ent->device == PCI_DEVICE_ID_ARTOP_AEC7610) {
2584 error = pci_read_config_byte(pdev, PCI_CLASS_REVISION, &atpdev->chip_ver);
2585 if (atpdev->chip_ver < 2)
2589 switch (ent->device) {
2590 case PCI_DEVICE_ID_ARTOP_AEC7612UW:
2591 case PCI_DEVICE_ID_ARTOP_AEC7612SUW:
2595 atpdev->chip_ver = 0x04;
2599 base_io = pci_resource_start(pdev, 0);
2600 base_io &= 0xfffffff8;
2602 if ((ent->device == ATP880_DEVID1)||(ent->device == ATP880_DEVID2)) {
2603 error = pci_read_config_byte(pdev, PCI_CLASS_REVISION, &atpdev->chip_ver);
2604 pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0x80);//JCC082803
2606 host_id = inb(base_io + 0x39);
2609 printk(KERN_INFO " ACARD AEC-67160 PCI Ultra3 LVD Host Adapter: %d"
2610 " IO:%x, IRQ:%d.\n", count, base_io, pdev->irq);
2611 atpdev->ioport[0] = base_io + 0x40;
2612 atpdev->pciport[0] = base_io + 0x28;
2613 atpdev->dev_id = ent->device;
2614 atpdev->host_id[0] = host_id;
2616 tmport = base_io + 0x22;
2617 atpdev->scam_on = inb(tmport);
2619 atpdev->global_map[0] = inb(tmport);
2621 atpdev->ultra_map[0] = inw(tmport);
2629 outw(n, base_io + 0x34);
2631 if (inb(base_io + 0x30) == 0xff)
2634 atpdev->sp[0][m++] = inb(base_io + 0x30);
2635 atpdev->sp[0][m++] = inb(base_io + 0x31);
2636 atpdev->sp[0][m++] = inb(base_io + 0x32);
2637 atpdev->sp[0][m++] = inb(base_io + 0x33);
2638 outw(n, base_io + 0x34);
2640 atpdev->sp[0][m++] = inb(base_io + 0x30);
2641 atpdev->sp[0][m++] = inb(base_io + 0x31);
2642 atpdev->sp[0][m++] = inb(base_io + 0x32);
2643 atpdev->sp[0][m++] = inb(base_io + 0x33);
2644 outw(n, base_io + 0x34);
2646 atpdev->sp[0][m++] = inb(base_io + 0x30);
2647 atpdev->sp[0][m++] = inb(base_io + 0x31);
2648 atpdev->sp[0][m++] = inb(base_io + 0x32);
2649 atpdev->sp[0][m++] = inb(base_io + 0x33);
2650 outw(n, base_io + 0x34);
2652 atpdev->sp[0][m++] = inb(base_io + 0x30);
2653 atpdev->sp[0][m++] = inb(base_io + 0x31);
2654 atpdev->sp[0][m++] = inb(base_io + 0x32);
2655 atpdev->sp[0][m++] = inb(base_io + 0x33);
2659 outw(0, base_io + 0x34);
2660 atpdev->ultra_map[0] = 0;
2661 atpdev->async[0] = 0;
2662 for (k = 0; k < 16; k++) {
2665 if (atpdev->sp[0][k] > 1) {
2666 atpdev->ultra_map[0] |= n;
2668 if (atpdev->sp[0][k] == 0)
2669 atpdev->async[0] |= n;
2672 atpdev->async[0] = ~(atpdev->async[0]);
2673 outb(atpdev->global_map[0], base_io + 0x35);
2675 shpnt = scsi_host_alloc(&atp870u_template, sizeof(struct atp_unit));
2679 p = (struct atp_unit *)&shpnt->hostdata;
2681 atpdev->host = shpnt;
2682 atpdev->pdev = pdev;
2683 pci_set_drvdata(pdev, p);
2684 memcpy(p, atpdev, sizeof(*atpdev));
2685 if (atp870u_init_tables(shpnt) < 0) {
2686 printk(KERN_ERR "Unable to allocate tables for Acard controller\n");
2690 if (request_irq(pdev->irq, atp870u_intr_handle, IRQF_SHARED, "atp880i", shpnt)) {
2691 printk(KERN_ERR "Unable to allocate IRQ%d for Acard controller.\n", pdev->irq);
2695 spin_lock_irqsave(shpnt->host_lock, flags);
2696 tmport = base_io + 0x38;
2697 k = inb(tmport) & 0x80;
2704 tmport = base_io + 0x5b;
2708 tmport = base_io + 0x40;
2709 outb((host_id | 0x08), tmport);
2713 while ((inb(tmport) & 0x80) == 0)
2717 tmport = base_io + 0x41;
2720 tmport = base_io + 0x51;
2725 tmport = base_io + 0x38;
2728 shpnt->this_id = host_id;
2729 shpnt->unique_id = base_io;
2730 shpnt->io_port = base_io;
2731 shpnt->n_io_port = 0x60; /* Number of bytes of I/O space used */
2732 shpnt->irq = pdev->irq;
2733 } else if (ent->device == ATP885_DEVID) {
2734 printk(KERN_INFO " ACARD AEC-67162 PCI Ultra3 LVD Host Adapter: IO:%x, IRQ:%d.\n"
2735 , base_io, pdev->irq);
2737 atpdev->pdev = pdev;
2738 atpdev->dev_id = ent->device;
2739 atpdev->baseport = base_io;
2740 atpdev->ioport[0] = base_io + 0x80;
2741 atpdev->ioport[1] = base_io + 0xc0;
2742 atpdev->pciport[0] = base_io + 0x40;
2743 atpdev->pciport[1] = base_io + 0x50;
2745 shpnt = scsi_host_alloc(&atp870u_template, sizeof(struct atp_unit));
2749 p = (struct atp_unit *)&shpnt->hostdata;
2751 atpdev->host = shpnt;
2752 atpdev->pdev = pdev;
2753 pci_set_drvdata(pdev, p);
2754 memcpy(p, atpdev, sizeof(struct atp_unit));
2755 if (atp870u_init_tables(shpnt) < 0)
2759 printk("request_irq() shpnt %p hostdata %p\n", shpnt, p);
2761 if (request_irq(pdev->irq, atp870u_intr_handle, IRQF_SHARED, "atp870u", shpnt)) {
2762 printk(KERN_ERR "Unable to allocate IRQ for Acard controller.\n");
2766 spin_lock_irqsave(shpnt->host_lock, flags);
2768 c=inb(base_io + 0x29);
2769 outb((c | 0x04),base_io + 0x29);
2776 outw(n,base_io + 0x3c);
2777 if (inl(base_io + 0x38) == 0xffffffff) {
2780 for (m=0; m < 2; m++) {
2781 p->global_map[m]= 0;
2782 for (k=0; k < 4; k++) {
2783 outw(n++,base_io + 0x3c);
2784 ((unsigned long *)&setupdata[m][0])[k]=inl(base_io + 0x38);
2786 for (k=0; k < 4; k++) {
2787 outw(n++,base_io + 0x3c);
2788 ((unsigned long *)&p->sp[m][0])[k]=inl(base_io + 0x38);
2795 printk( "Flash Read OK\n");
2797 c=inb(base_io + 0x29);
2798 outb((c & 0xfb),base_io + 0x29);
2799 for (c=0;c < 2;c++) {
2802 for (k=0; k < 16; k++) {
2805 if (p->sp[c][k] > 1) {
2806 p->ultra_map[c] |= n;
2808 if (p->sp[c][k] == 0) {
2813 p->async[c] = ~(p->async[c]);
2815 if (p->global_map[c] == 0) {
2817 if ((k & 0x40) != 0)
2818 p->global_map[c] |= 0x20;
2820 p->global_map[c] |= k;
2821 if ((setupdata[c][2] & 0x04) != 0)
2822 p->global_map[c] |= 0x08;
2823 p->host_id[c] = setupdata[c][0] & 0x07;
2827 k = inb(base_io + 0x28) & 0x8f;
2829 outb(k, base_io + 0x28);
2830 outb(0x80, base_io + 0x41);
2831 outb(0x80, base_io + 0x51);
2833 outb(0, base_io + 0x41);
2834 outb(0, base_io + 0x51);
2836 inb(base_io + 0x9b);
2837 inb(base_io + 0x97);
2838 inb(base_io + 0xdb);
2839 inb(base_io + 0xd7);
2840 tmport = base_io + 0x80;
2843 k = (k & 0x07) | 0x40;
2850 while ((inb(tmport) & 0x80) == 0)
2855 tmport = base_io + 0x81;
2858 tmport = base_io + 0x91;
2861 tmport = base_io + 0xc0;
2864 k = (k & 0x07) | 0x40;
2871 while ((inb(tmport) & 0x80) == 0)
2876 tmport = base_io + 0xc1;
2879 tmport = base_io + 0xd1;
2883 printk(KERN_INFO " Scanning Channel A SCSI Device ...\n");
2884 is885(p, base_io + 0x80, 0);
2885 printk(KERN_INFO " Scanning Channel B SCSI Device ...\n");
2886 is885(p, base_io + 0xc0, 1);
2888 k = inb(base_io + 0x28) & 0xcf;
2890 outb(k, base_io + 0x28);
2891 k = inb(base_io + 0x1f) | 0x80;
2892 outb(k, base_io + 0x1f);
2893 k = inb(base_io + 0x29) | 0x01;
2894 outb(k, base_io + 0x29);
2896 //printk("atp885: atp_host[0] 0x%p\n", atp_host[0]);
2899 shpnt->max_lun = (p->global_map[0] & 0x07) + 1;
2900 shpnt->max_channel = 1;
2901 shpnt->this_id = p->host_id[0];
2902 shpnt->unique_id = base_io;
2903 shpnt->io_port = base_io;
2904 shpnt->n_io_port = 0xff; /* Number of bytes of I/O space used */
2905 shpnt->irq = pdev->irq;
2908 error = pci_read_config_byte(pdev, 0x49, &host_id);
2910 printk(KERN_INFO " ACARD AEC-671X PCI Ultra/W SCSI-2/3 Host Adapter: %d "
2911 "IO:%x, IRQ:%d.\n", count, base_io, pdev->irq);
2913 atpdev->ioport[0] = base_io;
2914 atpdev->pciport[0] = base_io + 0x20;
2915 atpdev->dev_id = ent->device;
2917 atpdev->host_id[0] = host_id;
2918 tmport = base_io + 0x22;
2919 atpdev->scam_on = inb(tmport);
2921 atpdev->global_map[0] = inb(tmport++);
2922 atpdev->ultra_map[0] = inw(tmport);
2924 if (atpdev->ultra_map[0] == 0) {
2925 atpdev->scam_on = 0x00;
2926 atpdev->global_map[0] = 0x20;
2927 atpdev->ultra_map[0] = 0xffff;
2930 shpnt = scsi_host_alloc(&atp870u_template, sizeof(struct atp_unit));
2934 p = (struct atp_unit *)&shpnt->hostdata;
2936 atpdev->host = shpnt;
2937 atpdev->pdev = pdev;
2938 pci_set_drvdata(pdev, p);
2939 memcpy(p, atpdev, sizeof(*atpdev));
2940 if (atp870u_init_tables(shpnt) < 0)
2943 if (request_irq(pdev->irq, atp870u_intr_handle, IRQF_SHARED, "atp870i", shpnt)) {
2944 printk(KERN_ERR "Unable to allocate IRQ%d for Acard controller.\n", pdev->irq);
2948 spin_lock_irqsave(shpnt->host_lock, flags);
2949 if (atpdev->chip_ver > 0x07) { /* check if atp876 chip then enable terminator */
2950 tmport = base_io + 0x3e;
2954 tmport = base_io + 0x3a;
2955 k = (inb(tmport) & 0xf3) | 0x10;
2957 outb((k & 0xdf), tmport);
2962 outb((host_id | 0x08), tmport);
2966 while ((inb(tmport) & 0x80) == 0)
2971 tmport = base_io + 1;
2974 tmport = base_io + 0x11;
2979 tmport = base_io + 0x3a;
2980 outb((inb(tmport) & 0xef), tmport);
2982 outb((inb(tmport) | 0x20), tmport);
2983 if (atpdev->chip_ver == 4)
2987 shpnt->this_id = host_id;
2988 shpnt->unique_id = base_io;
2989 shpnt->io_port = base_io;
2990 shpnt->n_io_port = 0x40; /* Number of bytes of I/O space used */
2991 shpnt->irq = pdev->irq;
2993 spin_unlock_irqrestore(shpnt->host_lock, flags);
2994 if(ent->device==ATP885_DEVID) {
2995 if(!request_region(base_io, 0xff, "atp870u")) /* Register the IO ports that we use */
2996 goto request_io_fail;
2997 } else if((ent->device==ATP880_DEVID1)||(ent->device==ATP880_DEVID2)) {
2998 if(!request_region(base_io, 0x60, "atp870u")) /* Register the IO ports that we use */
2999 goto request_io_fail;
3001 if(!request_region(base_io, 0x40, "atp870u")) /* Register the IO ports that we use */
3002 goto request_io_fail;
3005 if (scsi_add_host(shpnt, &pdev->dev))
3007 scsi_scan_host(shpnt);
3009 printk("atp870u_prob : exit\n");
3014 printk("atp870u_prob:scsi_add_fail\n");
3015 if(ent->device==ATP885_DEVID) {
3016 release_region(base_io, 0xff);
3017 } else if((ent->device==ATP880_DEVID1)||(ent->device==ATP880_DEVID2)) {
3018 release_region(base_io, 0x60);
3020 release_region(base_io, 0x40);
3023 printk("atp870u_prob:request_io_fail\n");
3024 free_irq(pdev->irq, shpnt);
3026 printk("atp870u_prob:free_table\n");
3027 atp870u_free_tables(shpnt);
3029 printk("atp870u_prob:unregister\n");
3030 scsi_host_put(shpnt);
3040 /* The abort command does not leave the device in a clean state where
3041 it is available to be used again. Until this gets worked out, we will
3042 leave it commented out. */
3044 static int atp870u_abort(struct scsi_cmnd * SCpnt)
3046 unsigned char j, k, c;
3047 struct scsi_cmnd *workrequ;
3048 unsigned int tmport;
3049 struct atp_unit *dev;
3050 struct Scsi_Host *host;
3051 host = SCpnt->device->host;
3053 dev = (struct atp_unit *)&host->hostdata;
3054 c = scmd_channel(SCpnt);
3055 printk(" atp870u: abort Channel = %x \n", c);
3056 printk("working=%x last_cmd=%x ", dev->working[c], dev->last_cmd[c]);
3057 printk(" quhdu=%x quendu=%x ", dev->quhd[c], dev->quend[c]);
3058 tmport = dev->ioport[c];
3059 for (j = 0; j < 0x18; j++) {
3060 printk(" r%2x=%2x", j, inb(tmport++));
3063 printk(" r1c=%2x", inb(tmport));
3065 printk(" r1f=%2x in_snd=%2x ", inb(tmport), dev->in_snd[c]);
3066 tmport= dev->pciport[c];
3067 printk(" d00=%2x", inb(tmport));
3069 printk(" d02=%2x", inb(tmport));
3071 if (dev->id[c][j].curr_req != NULL) {
3072 workrequ = dev->id[c][j].curr_req;
3073 printk("\n que cdb= ");
3074 for (k=0; k < workrequ->cmd_len; k++) {
3075 printk(" %2x ",workrequ->cmnd[k]);
3077 printk(" last_lenu= %x ",(unsigned int)dev->id[c][j].last_len);
3083 static const char *atp870u_info(struct Scsi_Host *notused)
3085 static char buffer[128];
3087 strcpy(buffer, "ACARD AEC-6710/6712/67160 PCI Ultra/W/LVD SCSI-3 Adapter Driver V2.6+ac ");
3092 #define BLS buffer + len + size
3093 static int atp870u_proc_info(struct Scsi_Host *HBAptr, char *buffer,
3094 char **start, off_t offset, int length, int inout)
3096 static u8 buff[512];
3105 memset(buff, 0, sizeof(buff));
3106 size += sprintf(BLS, "ACARD AEC-671X Driver Version: 2.6+ac\n");
3111 size += sprintf(BLS, "\n");
3112 size += sprintf(BLS, "Adapter Configuration:\n");
3113 size += sprintf(BLS, " Base IO: %#.4lx\n", HBAptr->io_port);
3114 size += sprintf(BLS, " IRQ: %d\n", HBAptr->irq);
3118 *start = buffer + (offset - begin); /* Start of wanted data */
3119 len -= (offset - begin); /* Start slop */
3121 len = length; /* Ending slop */
3127 static int atp870u_biosparam(struct scsi_device *disk, struct block_device *dev,
3128 sector_t capacity, int *ip)
3130 int heads, sectors, cylinders;
3134 cylinders = (unsigned long)capacity / (heads * sectors);
3135 if (cylinders > 1024) {
3138 cylinders = (unsigned long)capacity / (heads * sectors);
3147 static void atp870u_remove (struct pci_dev *pdev)
3149 struct atp_unit *devext = pci_get_drvdata(pdev);
3150 struct Scsi_Host *pshost = devext->host;
3153 scsi_remove_host(pshost);
3154 printk(KERN_INFO "free_irq : %d\n",pshost->irq);
3155 free_irq(pshost->irq, pshost);
3156 release_region(pshost->io_port, pshost->n_io_port);
3157 printk(KERN_INFO "atp870u_free_tables : %p\n",pshost);
3158 atp870u_free_tables(pshost);
3159 printk(KERN_INFO "scsi_host_put : %p\n",pshost);
3160 scsi_host_put(pshost);
3161 printk(KERN_INFO "pci_set_drvdata : %p\n",pdev);
3162 pci_set_drvdata(pdev, NULL);
3164 MODULE_LICENSE("GPL");
3166 static struct scsi_host_template atp870u_template = {
3167 .module = THIS_MODULE,
3168 .name = "atp870u" /* name */,
3169 .proc_name = "atp870u",
3170 .proc_info = atp870u_proc_info,
3171 .info = atp870u_info /* info */,
3172 .queuecommand = atp870u_queuecommand /* queuecommand */,
3173 .eh_abort_handler = atp870u_abort /* abort */,
3174 .bios_param = atp870u_biosparam /* biosparm */,
3175 .can_queue = qcnt /* can_queue */,
3176 .this_id = 7 /* SCSI ID */,
3177 .sg_tablesize = ATP870U_SCATTER /*SG_ALL*/ /*SG_NONE*/,
3178 .cmd_per_lun = ATP870U_CMDLUN /* commands per lun */,
3179 .use_clustering = ENABLE_CLUSTERING,
3180 .max_sectors = ATP870U_MAX_SECTORS,
3183 static struct pci_device_id atp870u_id_table[] = {
3184 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, ATP885_DEVID) },
3185 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, ATP880_DEVID1) },
3186 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, ATP880_DEVID2) },
3187 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7610) },
3188 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612UW) },
3189 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612U) },
3190 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612S) },
3191 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612D) },
3192 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612SUW) },
3193 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_8060) },
3197 MODULE_DEVICE_TABLE(pci, atp870u_id_table);
3199 static struct pci_driver atp870u_driver = {
3200 .id_table = atp870u_id_table,
3202 .probe = atp870u_probe,
3203 .remove = __devexit_p(atp870u_remove),
3206 static int __init atp870u_init(void)
3209 printk("atp870u_init: Entry\n");
3211 return pci_register_driver(&atp870u_driver);
3214 static void __exit atp870u_exit(void)
3217 printk("atp870u_exit: Entry\n");
3219 pci_unregister_driver(&atp870u_driver);
3222 static void tscam_885(void)
3226 for (i = 0; i < 0x2; i++) {
3234 static void is885(struct atp_unit *dev, unsigned int wkport,unsigned char c)
3236 unsigned int tmport;
3237 unsigned char i, j, k, rmb, n, lvdmode;
3238 unsigned short int m;
3239 static unsigned char mbuf[512];
3240 static unsigned char satn[9] = {0, 0, 0, 0, 0, 0, 0, 6, 6};
3241 static unsigned char inqd[9] = {0x12, 0, 0, 0, 0x24, 0, 0, 0x24, 6};
3242 static unsigned char synn[6] = {0x80, 1, 3, 1, 0x19, 0x0e};
3243 unsigned char synu[6] = {0x80, 1, 3, 1, 0x0a, 0x0e};
3244 static unsigned char synw[6] = {0x80, 1, 3, 1, 0x19, 0x0e};
3245 unsigned char synuw[6] = {0x80, 1, 3, 1, 0x0a, 0x0e};
3246 static unsigned char wide[6] = {0x80, 1, 2, 3, 1, 0};
3247 static unsigned char u3[9] = { 0x80,1,6,4,0x09,00,0x0e,0x01,0x02 };
3249 lvdmode=inb(wkport + 0x1b) >> 7;
3251 for (i = 0; i < 16; i++) {
3254 if ((m & dev->active_id[c]) != 0) {
3257 if (i == dev->host_id[c]) {
3258 printk(KERN_INFO " ID: %2d Host Adapter\n", dev->host_id[c]);
3261 tmport = wkport + 0x1b;
3263 tmport = wkport + 0x01;
3264 outb(0x08, tmport++);
3265 outb(0x7f, tmport++);
3266 outb(satn[0], tmport++);
3267 outb(satn[1], tmport++);
3268 outb(satn[2], tmport++);
3269 outb(satn[3], tmport++);
3270 outb(satn[4], tmport++);
3271 outb(satn[5], tmport++);
3275 outb(dev->id[c][i].devsp, tmport++);
3278 outb(satn[6], tmport++);
3279 outb(satn[7], tmport++);
3281 if ((j & 0x08) != 0) {
3282 j = (j & 0x07) | 0x40;
3286 outb(satn[8], tmport);
3289 while ((inb(tmport) & 0x80) == 0x00)
3292 if ((inb(tmport) != 0x11) && (inb(tmport) != 0x8e)) {
3295 while (inb(tmport) != 0x8e)
3297 dev->active_id[c] |= m;
3299 tmport = wkport + 0x10;
3301 tmport = wkport + 0x14;
3305 tmport = wkport + 0x18;
3308 while ((inb(tmport) & 0x80) == 0x00)
3313 tmport = wkport + 0x10;
3318 tmport = wkport + 0x03;
3319 outb(inqd[0], tmport++);
3320 outb(inqd[1], tmport++);
3321 outb(inqd[2], tmport++);
3322 outb(inqd[3], tmport++);
3323 outb(inqd[4], tmport++);
3324 outb(inqd[5], tmport);
3328 outb(dev->id[c][i].devsp, tmport++);
3330 outb(inqd[6], tmport++);
3331 outb(inqd[7], tmport++);
3333 outb(inqd[8], tmport);
3335 while ((inb(tmport) & 0x80) == 0x00)
3338 if ((inb(tmport) != 0x11) && (inb(tmport) != 0x8e)) {
3341 while (inb(tmport) != 0x8e)
3343 tmport = wkport + 0x1b;
3345 tmport = wkport + 0x18;
3351 if ((k & 0x01) != 0) {
3353 mbuf[j++] = inb(tmport);
3357 if ((k & 0x80) == 0) {
3365 tmport = wkport + 0x10;
3374 while ((inb(tmport) & 0x80) == 0x00)
3377 if (inb(tmport) != 0x16) {
3382 printk( KERN_INFO" ID: %2d %s\n", i, &mbuf[8]);
3383 dev->id[c][i].devtype = mbuf[0];
3386 if ((mbuf[7] & 0x60) == 0) {
3389 if ((i < 8) && ((dev->global_map[c] & 0x20) == 0)) {
3395 if (dev->sp[c][i] != 0x04) { // force u2
3399 tmport = wkport + 0x1b;
3401 tmport = wkport + 0x03;
3402 outb(satn[0], tmport++);
3403 outb(satn[1], tmport++);
3404 outb(satn[2], tmport++);
3405 outb(satn[3], tmport++);
3406 outb(satn[4], tmport++);
3407 outb(satn[5], tmport++);
3411 outb(dev->id[c][i].devsp, tmport++);
3413 outb(satn[6], tmport++);
3414 outb(satn[7], tmport++);
3416 outb(satn[8], tmport);
3419 while ((inb(tmport) & 0x80) == 0x00)
3422 if ((inb(tmport) != 0x11) && (inb(tmport) != 0x8e)) {
3425 while (inb(tmport) != 0x8e)
3429 tmport = wkport + 0x14;
3435 while ((inb(tmport) & 0x80) == 0) {
3436 if ((inb(tmport) & 0x01) != 0) {
3438 outb(u3[j++], tmport);
3444 while ((inb(tmport) & 0x80) == 0x00)
3446 j = inb(tmport) & 0x0f;
3458 tmport = wkport + 0x18;
3461 while ((inb(tmport) & 0x80) == 0) {
3462 if ((inb(tmport) & 0x01) != 0) {
3470 j = inb(tmport) & 0x0f;
3482 tmport = wkport + 0x14;
3490 if ((j & 0x01) != 0) {
3492 mbuf[k++] = inb(tmport);
3496 if ((j & 0x80) == 0x00) {
3500 j = inb(tmport) & 0x0f;
3512 tmport = wkport + 0x10;
3514 tmport = wkport + 0x14;
3519 while ((inb(tmport) & 0x80) == 0x00);
3528 if (mbuf[0] != 0x01) {
3531 if (mbuf[1] != 0x06) {
3534 if (mbuf[2] != 0x04) {
3537 if (mbuf[3] == 0x09) {
3540 dev->wide_id[c] |= m;
3541 dev->id[c][i].devsp = 0xce;
3543 printk("dev->id[%2d][%2d].devsp = %2x\n",c,i,dev->id[c][i].devsp);
3548 tmport = wkport + 0x1b;
3550 tmport = wkport + 0x03;
3551 outb(satn[0], tmport++);
3552 outb(satn[1], tmport++);
3553 outb(satn[2], tmport++);
3554 outb(satn[3], tmport++);
3555 outb(satn[4], tmport++);
3556 outb(satn[5], tmport++);
3560 outb(dev->id[c][i].devsp, tmport++);
3562 outb(satn[6], tmport++);
3563 outb(satn[7], tmport++);
3565 outb(satn[8], tmport);
3568 while ((inb(tmport) & 0x80) == 0x00)
3571 if ((inb(tmport) != 0x11) && (inb(tmport) != 0x8e)) {
3574 while (inb(tmport) != 0x8e)
3578 tmport = wkport + 0x14;
3584 while ((inb(tmport) & 0x80) == 0) {
3585 if ((inb(tmport) & 0x01) != 0) {
3587 outb(wide[j++], tmport);
3593 while ((inb(tmport) & 0x80) == 0x00)
3595 j = inb(tmport) & 0x0f;
3607 tmport = wkport + 0x18;
3610 while ((inb(tmport) & 0x80) == 0) {
3611 if ((inb(tmport) & 0x01) != 0) {
3619 j = inb(tmport) & 0x0f;
3631 tmport = wkport + 0x14;
3639 if ((j & 0x01) != 0) {
3641 mbuf[k++] = inb(tmport);
3645 if ((j & 0x80) == 0x00) {
3649 j = inb(tmport) & 0x0f;
3661 tmport = wkport + 0x10;
3663 tmport = wkport + 0x14;
3668 while ((inb(tmport) & 0x80) == 0x00)
3678 if (mbuf[0] != 0x01) {
3681 if (mbuf[1] != 0x02) {
3684 if (mbuf[2] != 0x03) {
3687 if (mbuf[3] != 0x01) {
3692 dev->wide_id[c] |= m;
3694 if ((dev->id[c][i].devtype == 0x00) || (dev->id[c][i].devtype == 0x07) ||
3695 ((dev->id[c][i].devtype == 0x05) && ((n & 0x10) != 0))) {
3698 if ((dev->async[c] & m) != 0) {
3704 if (dev->sp[c][i] == 0x02) {
3708 if (dev->sp[c][i] >= 0x03) {
3713 tmport = wkport + 0x1b;
3715 if ((m & dev->wide_id[c]) != 0) {
3719 tmport = wkport + 0x03;
3720 outb(satn[0], tmport++);
3721 outb(satn[1], tmport++);
3722 outb(satn[2], tmport++);
3723 outb(satn[3], tmport++);
3724 outb(satn[4], tmport++);
3725 outb(satn[5], tmport++);
3729 outb(dev->id[c][i].devsp, tmport++);
3731 outb(satn[6], tmport++);
3732 outb(satn[7], tmport++);
3734 outb(satn[8], tmport);
3737 while ((inb(tmport) & 0x80) == 0x00)
3740 if ((inb(tmport) != 0x11) && (inb(tmport) != 0x8e)) {
3743 while (inb(tmport) != 0x8e)
3747 tmport = wkport + 0x14;
3753 while ((inb(tmport) & 0x80) == 0) {
3754 if ((inb(tmport) & 0x01) != 0) {
3756 if ((m & dev->wide_id[c]) != 0) {
3757 if ((m & dev->ultra_map[c]) != 0) {
3758 outb(synuw[j++], tmport);
3760 outb(synw[j++], tmport);
3763 if ((m & dev->ultra_map[c]) != 0) {
3764 outb(synu[j++], tmport);
3766 outb(synn[j++], tmport);
3773 while ((inb(tmport) & 0x80) == 0x00)
3775 j = inb(tmport) & 0x0f;
3787 tmport = wkport + 0x18;
3790 while ((inb(tmport) & 0x80) == 0x00) {
3791 if ((inb(tmport) & 0x01) != 0x00) {
3815 tmport = wkport + 0x14;
3823 if ((j & 0x01) != 0x00) {
3825 mbuf[k++] = inb(tmport);
3829 if ((j & 0x80) == 0x00) {
3833 while ((inb(tmport) & 0x80) == 0x00);
3850 tmport = wkport + 0x10;
3853 tmport = wkport + 0x14;
3858 while ((inb(tmport) & 0x80) == 0x00)
3865 if (mbuf[0] != 0x01) {
3868 if (mbuf[1] != 0x03) {
3871 if (mbuf[4] == 0x00) {
3874 if (mbuf[3] > 0x64) {
3877 if (mbuf[4] > 0x0e) {
3880 dev->id[c][i].devsp = mbuf[4];
3881 if (mbuf[3] < 0x0c){
3885 if ((mbuf[3] < 0x0d) && (rmb == 0)) {
3889 if (mbuf[3] < 0x1a) {
3893 if (mbuf[3] < 0x33) {
3897 if (mbuf[3] < 0x4c) {
3903 dev->id[c][i].devsp = (dev->id[c][i].devsp & 0x0f) | j;
3905 printk("dev->id[%2d][%2d].devsp = %2x\n",c,i,dev->id[c][i].devsp);
3908 tmport = wkport + 0x16;
3912 module_init(atp870u_init);
3913 module_exit(atp870u_exit);