?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
allow coexistance of N build and AC build.
[tomato.git] / release / src-rt-6.x / linux / linux-2.6 / drivers / scsi / atp870u.c
blobfec58cc47f1cce78de21d0fc05c878d0a92d4c74
1 /*
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 <alan@redhat.com>
5 * 2.6.x update (C) 2004 Red Hat <alan@redhat.com>
6 *
7 * Marcelo Tosatti <marcelo@conectiva.com.br> : SMP fixes
8 *
9 * Wu Ching Chen : NULL pointer fixes 2000/06/02
10 * support atp876 chip
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)
16 *
17 * atp885 support add by ACARD Hao Ping Lian 2005/01/05
18 */
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 <asm/system.h>
33 #include <asm/io.h>
34
35 #include <scsi/scsi.h>
36 #include <scsi/scsi_cmnd.h>
37 #include <scsi/scsi_device.h>
38 #include <scsi/scsi_host.h>
39
40 #include "atp870u.h"
41
42 static struct scsi_host_template atp870u_template;
43 static void send_s870(struct atp_unit *dev,unsigned char c);
44 static void is885(struct atp_unit *dev, unsigned int wkport,unsigned char c);
45 static void tscam_885(void);
46
47 static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
48 {
49 unsigned long flags;
50 unsigned short int tmpcip, id;
51 unsigned char i, j, c, target_id, lun,cmdp;
52 unsigned char *prd;
53 struct scsi_cmnd *workreq;
54 unsigned int workport, tmport, tmport1;
55 unsigned long adrcnt, k;
56 #ifdef ED_DBGP
57 unsigned long l;
58 #endif
59 int errstus;
60 struct Scsi_Host *host = dev_id;
61 struct atp_unit *dev = (struct atp_unit *)&host->hostdata;
62
63 for (c = 0; c < 2; c++) {
64 tmport = dev->ioport[c] + 0x1f;
65 j = inb(tmport);
66 if ((j & 0x80) != 0)
67 {
68 goto ch_sel;
69 }
70 dev->in_int[c] = 0;
71 }
72 return IRQ_NONE;
73 ch_sel:
74 #ifdef ED_DBGP
75 printk("atp870u_intr_handle enter\n");
76 #endif
77 dev->in_int[c] = 1;
78 cmdp = inb(dev->ioport[c] + 0x10);
79 workport = dev->ioport[c];
80 if (dev->working[c] != 0) {
81 if (dev->dev_id == ATP885_DEVID) {
82 tmport1 = workport + 0x16;
83 if ((inb(tmport1) & 0x80) == 0)
84 outb((inb(tmport1) | 0x80), tmport1);
85 }
86 tmpcip = dev->pciport[c];
87 if ((inb(tmpcip) & 0x08) != 0)
88 {
89 tmpcip += 0x2;
90 for (k=0; k < 1000; k++) {
91 if ((inb(tmpcip) & 0x08) == 0) {
92 goto stop_dma;
93 }
94 if ((inb(tmpcip) & 0x01) == 0) {
95 goto stop_dma;
96 }
97 }
98 }
99 stop_dma:
100 tmpcip = dev->pciport[c];
101 outb(0x00, tmpcip);
102 tmport -= 0x08;
103
104 i = inb(tmport);
105
106 if (dev->dev_id == ATP885_DEVID) {
107 tmpcip += 2;
108 outb(0x06, tmpcip);
109 tmpcip -= 2;
110 }
111
112 tmport -= 0x02;
113 target_id = inb(tmport);
114 tmport += 0x02;
115
116 /*
117 * Remap wide devices onto id numbers
118 */
119
120 if ((target_id & 0x40) != 0) {
121 target_id = (target_id & 0x07) | 0x08;
122 } else {
123 target_id &= 0x07;
124 }
125
126 if ((j & 0x40) != 0) {
127 if (dev->last_cmd[c] == 0xff) {
128 dev->last_cmd[c] = target_id;
129 }
130 dev->last_cmd[c] |= 0x40;
131 }
132 if (dev->dev_id == ATP885_DEVID)
133 dev->r1f[c][target_id] |= j;
134 #ifdef ED_DBGP
135 printk("atp870u_intr_handle status = %x\n",i);
136 #endif
137 if (i == 0x85) {
138 if ((dev->last_cmd[c] & 0xf0) != 0x40) {
139 dev->last_cmd[c] = 0xff;
140 }
141 if (dev->dev_id == ATP885_DEVID) {
142 tmport -= 0x05;
143 adrcnt = 0;
144 ((unsigned char *) &adrcnt)[2] = inb(tmport++);
145 ((unsigned char *) &adrcnt)[1] = inb(tmport++);
146 ((unsigned char *) &adrcnt)[0] = inb(tmport);
147 if (dev->id[c][target_id].last_len != adrcnt)
148 {
149 k = dev->id[c][target_id].last_len;
150 k -= adrcnt;
151 dev->id[c][target_id].tran_len = k;
152 dev->id[c][target_id].last_len = adrcnt;
153 }
154 #ifdef ED_DBGP
155 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);
156 #endif
157 }
158
159 /*
160 * Flip wide
161 */
162 if (dev->wide_id[c] != 0) {
163 tmport = workport + 0x1b;
164 outb(0x01, tmport);
165 while ((inb(tmport) & 0x01) != 0x01) {
166 outb(0x01, tmport);
167 }
168 }
169 /*
170 * Issue more commands
171 */
172 spin_lock_irqsave(dev->host->host_lock, flags);
173 if (((dev->quhd[c] != dev->quend[c]) || (dev->last_cmd[c] != 0xff)) &&
174 (dev->in_snd[c] == 0)) {
175 #ifdef ED_DBGP
176 printk("Call sent_s870\n");
177 #endif
178 send_s870(dev,c);
179 }
180 spin_unlock_irqrestore(dev->host->host_lock, flags);
181 /*
182 * Done
183 */
184 dev->in_int[c] = 0;
185 #ifdef ED_DBGP
186 printk("Status 0x85 return\n");
187 #endif
188 goto handled;
189 }
190
191 if (i == 0x40) {
192 dev->last_cmd[c] |= 0x40;
193 dev->in_int[c] = 0;
194 goto handled;
195 }
196
197 if (i == 0x21) {
198 if ((dev->last_cmd[c] & 0xf0) != 0x40) {
199 dev->last_cmd[c] = 0xff;
200 }
201 tmport -= 0x05;
202 adrcnt = 0;
203 ((unsigned char *) &adrcnt)[2] = inb(tmport++);
204 ((unsigned char *) &adrcnt)[1] = inb(tmport++);
205 ((unsigned char *) &adrcnt)[0] = inb(tmport);
206 k = dev->id[c][target_id].last_len;
207 k -= adrcnt;
208 dev->id[c][target_id].tran_len = k;
209 dev->id[c][target_id].last_len = adrcnt;
210 tmport -= 0x04;
211 outb(0x41, tmport);
212 tmport += 0x08;
213 outb(0x08, tmport);
214 dev->in_int[c] = 0;
215 goto handled;
216 }
217
218 if (dev->dev_id == ATP885_DEVID) {
219 if ((i == 0x4c) || (i == 0x4d) || (i == 0x8c) || (i == 0x8d)) {
220 if ((i == 0x4c) || (i == 0x8c))
221 i=0x48;
222 else
223 i=0x49;
224 }
225
226 }
227 if ((i == 0x80) || (i == 0x8f)) {
228 #ifdef ED_DBGP
229 printk(KERN_DEBUG "Device reselect\n");
230 #endif
231 lun = 0;
232 tmport -= 0x07;
233 if (cmdp == 0x44 || i==0x80) {
234 tmport += 0x0d;
235 lun = inb(tmport) & 0x07;
236 } else {
237 if ((dev->last_cmd[c] & 0xf0) != 0x40) {
238 dev->last_cmd[c] = 0xff;
239 }
240 if (cmdp == 0x41) {
241 #ifdef ED_DBGP
242 printk("cmdp = 0x41\n");
243 #endif
244 tmport += 0x02;
245 adrcnt = 0;
246 ((unsigned char *) &adrcnt)[2] = inb(tmport++);
247 ((unsigned char *) &adrcnt)[1] = inb(tmport++);
248 ((unsigned char *) &adrcnt)[0] = inb(tmport);
249 k = dev->id[c][target_id].last_len;
250 k -= adrcnt;
251 dev->id[c][target_id].tran_len = k;
252 dev->id[c][target_id].last_len = adrcnt;
253 tmport += 0x04;
254 outb(0x08, tmport);
255 dev->in_int[c] = 0;
256 goto handled;
257 } else {
258 #ifdef ED_DBGP
259 printk("cmdp != 0x41\n");
260 #endif
261 outb(0x46, tmport);
262 dev->id[c][target_id].dirct = 0x00;
263 tmport += 0x02;
264 outb(0x00, tmport++);
265 outb(0x00, tmport++);
266 outb(0x00, tmport++);
267 tmport += 0x03;
268 outb(0x08, tmport);
269 dev->in_int[c] = 0;
270 goto handled;
271 }
272 }
273 if (dev->last_cmd[c] != 0xff) {
274 dev->last_cmd[c] |= 0x40;
275 }
276 if (dev->dev_id == ATP885_DEVID) {
277 j = inb(dev->baseport + 0x29) & 0xfe;
278 outb(j, dev->baseport + 0x29);
279 tmport = workport + 0x16;
280 } else {
281 tmport = workport + 0x10;
282 outb(0x45, tmport);
283 tmport += 0x06;
284 }
285
286 target_id = inb(tmport);
287 /*
288 * Remap wide identifiers
289 */
290 if ((target_id & 0x10) != 0) {
291 target_id = (target_id & 0x07) | 0x08;
292 } else {
293 target_id &= 0x07;
294 }
295 if (dev->dev_id == ATP885_DEVID) {
296 tmport = workport + 0x10;
297 outb(0x45, tmport);
298 }
299 workreq = dev->id[c][target_id].curr_req;
300 #ifdef ED_DBGP
301 scmd_printk(KERN_DEBUG, workreq, "CDB");
302 for (l = 0; l < workreq->cmd_len; l++)
303 printk(KERN_DEBUG " %x",workreq->cmnd[l]);
304 printk("\n");
305 #endif
306
307 tmport = workport + 0x0f;
308 outb(lun, tmport);
309 tmport += 0x02;
310 outb(dev->id[c][target_id].devsp, tmport++);
311 adrcnt = dev->id[c][target_id].tran_len;
312 k = dev->id[c][target_id].last_len;
313
314 outb(((unsigned char *) &k)[2], tmport++);
315 outb(((unsigned char *) &k)[1], tmport++);
316 outb(((unsigned char *) &k)[0], tmport++);
317 #ifdef ED_DBGP
318 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));
319 #endif
320 /* Remap wide */
321 j = target_id;
322 if (target_id > 7) {
323 j = (j & 0x07) | 0x40;
324 }
325 /* Add direction */
326 j |= dev->id[c][target_id].dirct;
327 outb(j, tmport++);
328 outb(0x80,tmport);
329
330 /* enable 32 bit fifo transfer */
331 if (dev->dev_id == ATP885_DEVID) {
332 tmpcip = dev->pciport[c] + 1;
333 i=inb(tmpcip) & 0xf3;
334 //j=workreq->cmnd[0];
335 if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
336 i |= 0x0c;
337 }
338 outb(i,tmpcip);
339 } else if ((dev->dev_id == ATP880_DEVID1) ||
340 (dev->dev_id == ATP880_DEVID2) ) {
341 tmport = workport - 0x05;
342 if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
343 outb((unsigned char) ((inb(tmport) & 0x3f) | 0xc0), tmport);
344 } else {
345 outb((unsigned char) (inb(tmport) & 0x3f), tmport);
346 }
347 } else {
348 tmport = workport + 0x3a;
349 if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
350 outb((unsigned char) ((inb(tmport) & 0xf3) | 0x08), tmport);
351 } else {
352 outb((unsigned char) (inb(tmport) & 0xf3), tmport);
353 }
354 }
355 tmport = workport + 0x1b;
356 j = 0;
357 id = 1;
358 id = id << target_id;
359 /*
360 * Is this a wide device
361 */
362 if ((id & dev->wide_id[c]) != 0) {
363 j |= 0x01;
364 }
365 outb(j, tmport);
366 while ((inb(tmport) & 0x01) != j) {
367 outb(j,tmport);
368 }
369 if (dev->id[c][target_id].last_len == 0) {
370 tmport = workport + 0x18;
371 outb(0x08, tmport);
372 dev->in_int[c] = 0;
373 #ifdef ED_DBGP
374 printk("dev->id[c][target_id].last_len = 0\n");
375 #endif
376 goto handled;
377 }
378 #ifdef ED_DBGP
379 printk("target_id = %d adrcnt = %d\n",target_id,adrcnt);
380 #endif
381 prd = dev->id[c][target_id].prd_pos;
382 while (adrcnt != 0) {
383 id = ((unsigned short int *)prd)[2];
384 if (id == 0) {
385 k = 0x10000;
386 } else {
387 k = id;
388 }
389 if (k > adrcnt) {
390 ((unsigned short int *)prd)[2] = (unsigned short int)
391 (k - adrcnt);
392 ((unsigned long *)prd)[0] += adrcnt;
393 adrcnt = 0;
394 dev->id[c][target_id].prd_pos = prd;
395 } else {
396 adrcnt -= k;
397 dev->id[c][target_id].prdaddr += 0x08;
398 prd += 0x08;
399 if (adrcnt == 0) {
400 dev->id[c][target_id].prd_pos = prd;
401 }
402 }
403 }
404 tmpcip = dev->pciport[c] + 0x04;
405 outl(dev->id[c][target_id].prdaddr, tmpcip);
406 #ifdef ED_DBGP
407 printk("dev->id[%d][%d].prdaddr 0x%8x\n", c, target_id, dev->id[c][target_id].prdaddr);
408 #endif
409 if (dev->dev_id == ATP885_DEVID) {
410 tmpcip -= 0x04;
411 } else {
412 tmpcip -= 0x02;
413 outb(0x06, tmpcip);
414 outb(0x00, tmpcip);
415 tmpcip -= 0x02;
416 }
417 tmport = workport + 0x18;
418 /*
419 * Check transfer direction
420 */
421 if (dev->id[c][target_id].dirct != 0) {
422 outb(0x08, tmport);
423 outb(0x01, tmpcip);
424 dev->in_int[c] = 0;
425 #ifdef ED_DBGP
426 printk("status 0x80 return dirct != 0\n");
427 #endif
428 goto handled;
429 }
430 outb(0x08, tmport);
431 outb(0x09, tmpcip);
432 dev->in_int[c] = 0;
433 #ifdef ED_DBGP
434 printk("status 0x80 return dirct = 0\n");
435 #endif
436 goto handled;
437 }
438
439 /*
440 * Current scsi request on this target
441 */
442
443 workreq = dev->id[c][target_id].curr_req;
444
445 if (i == 0x42) {
446 if ((dev->last_cmd[c] & 0xf0) != 0x40)
447 {
448 dev->last_cmd[c] = 0xff;
449 }
450 errstus = 0x02;
451 workreq->result = errstus;
452 goto go_42;
453 }
454 if (i == 0x16) {
455 if ((dev->last_cmd[c] & 0xf0) != 0x40) {
456 dev->last_cmd[c] = 0xff;
457 }
458 errstus = 0;
459 tmport -= 0x08;
460 errstus = inb(tmport);
461 if (((dev->r1f[c][target_id] & 0x10) != 0)&&(dev->dev_id==ATP885_DEVID)) {
462 printk(KERN_WARNING "AEC67162 CRC ERROR !\n");
463 errstus = 0x02;
464 }
465 workreq->result = errstus;
466 go_42:
467 if (dev->dev_id == ATP885_DEVID) {
468 j = inb(dev->baseport + 0x29) | 0x01;
469 outb(j, dev->baseport + 0x29);
470 }
471 /*
472 * Complete the command
473 */
474 if (workreq->use_sg) {
475 pci_unmap_sg(dev->pdev,
476 (struct scatterlist *)workreq->request_buffer,
477 workreq->use_sg,
478 workreq->sc_data_direction);
479 } else if (workreq->request_bufflen &&
480 workreq->sc_data_direction != DMA_NONE) {
481 pci_unmap_single(dev->pdev,
482 workreq->SCp.dma_handle,
483 workreq->request_bufflen,
484 workreq->sc_data_direction);
485 }
486 spin_lock_irqsave(dev->host->host_lock, flags);
487 (*workreq->scsi_done) (workreq);
488 #ifdef ED_DBGP
489 printk("workreq->scsi_done\n");
490 #endif
491 /*
492 * Clear it off the queue
493 */
494 dev->id[c][target_id].curr_req = NULL;
495 dev->working[c]--;
496 spin_unlock_irqrestore(dev->host->host_lock, flags);
497 /*
498 * Take it back wide
499 */
500 if (dev->wide_id[c] != 0) {
501 tmport = workport + 0x1b;
502 outb(0x01, tmport);
503 while ((inb(tmport) & 0x01) != 0x01) {
504 outb(0x01, tmport);
505 }
506 }
507 /*
508 * If there is stuff to send and nothing going then send it
509 */
510 spin_lock_irqsave(dev->host->host_lock, flags);
511 if (((dev->last_cmd[c] != 0xff) || (dev->quhd[c] != dev->quend[c])) &&
512 (dev->in_snd[c] == 0)) {
513 #ifdef ED_DBGP
514 printk("Call sent_s870(scsi_done)\n");
515 #endif
516 send_s870(dev,c);
517 }
518 spin_unlock_irqrestore(dev->host->host_lock, flags);
519 dev->in_int[c] = 0;
520 goto handled;
521 }
522 if ((dev->last_cmd[c] & 0xf0) != 0x40) {
523 dev->last_cmd[c] = 0xff;
524 }
525 if (i == 0x4f) {
526 i = 0x89;
527 }
528 i &= 0x0f;
529 if (i == 0x09) {
530 tmpcip += 4;
531 outl(dev->id[c][target_id].prdaddr, tmpcip);
532 tmpcip = tmpcip - 2;
533 outb(0x06, tmpcip);
534 outb(0x00, tmpcip);
535 tmpcip = tmpcip - 2;
536 tmport = workport + 0x10;
537 outb(0x41, tmport);
538 if (dev->dev_id == ATP885_DEVID) {
539 tmport += 2;
540 k = dev->id[c][target_id].last_len;
541 outb((unsigned char) (((unsigned char *) (&k))[2]), tmport++);
542 outb((unsigned char) (((unsigned char *) (&k))[1]), tmport++);
543 outb((unsigned char) (((unsigned char *) (&k))[0]), tmport);
544 dev->id[c][target_id].dirct = 0x00;
545 tmport += 0x04;
546 } else {
547 dev->id[c][target_id].dirct = 0x00;
548 tmport += 0x08;
549 }
550 outb(0x08, tmport);
551 outb(0x09, tmpcip);
552 dev->in_int[c] = 0;
553 goto handled;
554 }
555 if (i == 0x08) {
556 tmpcip += 4;
557 outl(dev->id[c][target_id].prdaddr, tmpcip);
558 tmpcip = tmpcip - 2;
559 outb(0x06, tmpcip);
560 outb(0x00, tmpcip);
561 tmpcip = tmpcip - 2;
562 tmport = workport + 0x10;
563 outb(0x41, tmport);
564 if (dev->dev_id == ATP885_DEVID) {
565 tmport += 2;
566 k = dev->id[c][target_id].last_len;
567 outb((unsigned char) (((unsigned char *) (&k))[2]), tmport++);
568 outb((unsigned char) (((unsigned char *) (&k))[1]), tmport++);
569 outb((unsigned char) (((unsigned char *) (&k))[0]), tmport++);
570 } else {
571 tmport += 5;
572 }
573 outb((unsigned char) (inb(tmport) | 0x20), tmport);
574 dev->id[c][target_id].dirct = 0x20;
575 tmport += 0x03;
576 outb(0x08, tmport);
577 outb(0x01, tmpcip);
578 dev->in_int[c] = 0;
579 goto handled;
580 }
581 tmport -= 0x07;
582 if (i == 0x0a) {
583 outb(0x30, tmport);
584 } else {
585 outb(0x46, tmport);
586 }
587 dev->id[c][target_id].dirct = 0x00;
588 tmport += 0x02;
589 outb(0x00, tmport++);
590 outb(0x00, tmport++);
591 outb(0x00, tmport++);
592 tmport += 0x03;
593 outb(0x08, tmport);
594 dev->in_int[c] = 0;
595 goto handled;
596 } else {
597 // tmport = workport + 0x17;
598 // inb(tmport);
599 // dev->working[c] = 0;
600 dev->in_int[c] = 0;
601 goto handled;
602 }
603
604 handled:
605 #ifdef ED_DBGP
606 printk("atp870u_intr_handle exit\n");
607 #endif
608 return IRQ_HANDLED;
609 }
610 /**
611 * atp870u_queuecommand - Queue SCSI command
612 * @req_p: request block
613 * @done: completion function
614 *
615 * Queue a command to the ATP queue. Called with the host lock held.
616 */
617 static int atp870u_queuecommand(struct scsi_cmnd * req_p,
618 void (*done) (struct scsi_cmnd *))
619 {
620 unsigned char c;
621 unsigned int tmport,m;
622 struct atp_unit *dev;
623 struct Scsi_Host *host;
624
625 c = scmd_channel(req_p);
626 req_p->sense_buffer[0]=0;
627 req_p->resid = 0;
628 if (scmd_channel(req_p) > 1) {
629 req_p->result = 0x00040000;
630 done(req_p);
631 #ifdef ED_DBGP
632 printk("atp870u_queuecommand : req_p->device->channel > 1\n");
633 #endif
634 return 0;
635 }
636
637 host = req_p->device->host;
638 dev = (struct atp_unit *)&host->hostdata;
639
640
641
642 m = 1;
643 m = m << scmd_id(req_p);
644
645 /*
646 * Fake a timeout for missing targets
647 */
648
649 if ((m & dev->active_id[c]) == 0) {
650 req_p->result = 0x00040000;
651 done(req_p);
652 return 0;
653 }
654
655 if (done) {
656 req_p->scsi_done = done;
657 } else {
658 #ifdef ED_DBGP
659 printk( "atp870u_queuecommand: done can't be NULL\n");
660 #endif
661 req_p->result = 0;
662 done(req_p);
663 return 0;
664 }
665
666 /*
667 * Count new command
668 */
669 dev->quend[c]++;
670 if (dev->quend[c] >= qcnt) {
671 dev->quend[c] = 0;
672 }
673
674 /*
675 * Check queue state
676 */
677 if (dev->quhd[c] == dev->quend[c]) {
678 if (dev->quend[c] == 0) {
679 dev->quend[c] = qcnt;
680 }
681 #ifdef ED_DBGP
682 printk("atp870u_queuecommand : dev->quhd[c] == dev->quend[c]\n");
683 #endif
684 dev->quend[c]--;
685 req_p->result = 0x00020000;
686 done(req_p);
687 return 0;
688 }
689 dev->quereq[c][dev->quend[c]] = req_p;
690 tmport = dev->ioport[c] + 0x1c;
691 #ifdef ED_DBGP
692 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]);
693 #endif
694 if ((inb(tmport) == 0) && (dev->in_int[c] == 0) && (dev->in_snd[c] == 0)) {
695 #ifdef ED_DBGP
696 printk("Call sent_s870(atp870u_queuecommand)\n");
697 #endif
698 send_s870(dev,c);
699 }
700 #ifdef ED_DBGP
701 printk("atp870u_queuecommand : exit\n");
702 #endif
703 return 0;
704 }
705
706 /**
707 * send_s870 - send a command to the controller
708 * @host: host
709 *
710 * On entry there is work queued to be done. We move some of that work to the
711 * controller itself.
712 *
713 * Caller holds the host lock.
714 */
715 static void send_s870(struct atp_unit *dev,unsigned char c)
716 {
717 unsigned int tmport;
718 struct scsi_cmnd *workreq;
719 unsigned int i;//,k;
720 unsigned char j, target_id;
721 unsigned char *prd;
722 unsigned short int tmpcip, w;
723 unsigned long l, bttl = 0;
724 unsigned int workport;
725 struct scatterlist *sgpnt;
726 unsigned long sg_count;
727
728 if (dev->in_snd[c] != 0) {
729 #ifdef ED_DBGP
730 printk("cmnd in_snd\n");
731 #endif
732 return;
733 }
734 #ifdef ED_DBGP
735 printk("Sent_s870 enter\n");
736 #endif
737 dev->in_snd[c] = 1;
738 if ((dev->last_cmd[c] != 0xff) && ((dev->last_cmd[c] & 0x40) != 0)) {
739 dev->last_cmd[c] &= 0x0f;
740 workreq = dev->id[c][dev->last_cmd[c]].curr_req;
741 if (workreq != NULL) { /* check NULL pointer */
742 goto cmd_subp;
743 }
744 dev->last_cmd[c] = 0xff;
745 if (dev->quhd[c] == dev->quend[c]) {
746 dev->in_snd[c] = 0;
747 return ;
748 }
749 }
750 if ((dev->last_cmd[c] != 0xff) && (dev->working[c] != 0)) {
751 dev->in_snd[c] = 0;
752 return ;
753 }
754 dev->working[c]++;
755 j = dev->quhd[c];
756 dev->quhd[c]++;
757 if (dev->quhd[c] >= qcnt) {
758 dev->quhd[c] = 0;
759 }
760 workreq = dev->quereq[c][dev->quhd[c]];
761 if (dev->id[c][scmd_id(workreq)].curr_req == 0) {
762 dev->id[c][scmd_id(workreq)].curr_req = workreq;
763 dev->last_cmd[c] = scmd_id(workreq);
764 goto cmd_subp;
765 }
766 dev->quhd[c] = j;
767 dev->working[c]--;
768 dev->in_snd[c] = 0;
769 return;
770 cmd_subp:
771 workport = dev->ioport[c];
772 tmport = workport + 0x1f;
773 if ((inb(tmport) & 0xb0) != 0) {
774 goto abortsnd;
775 }
776 tmport = workport + 0x1c;
777 if (inb(tmport) == 0) {
778 goto oktosend;
779 }
780 abortsnd:
781 #ifdef ED_DBGP
782 printk("Abort to Send\n");
783 #endif
784 dev->last_cmd[c] |= 0x40;
785 dev->in_snd[c] = 0;
786 return;
787 oktosend:
788 #ifdef ED_DBGP
789 printk("OK to Send\n");
790 scmd_printk(KERN_DEBUG, workreq, "CDB");
791 for(i=0;i<workreq->cmd_len;i++) {
792 printk(" %x",workreq->cmnd[i]);
793 }
794 printk("\n");
795 #endif
796 if (dev->dev_id == ATP885_DEVID) {
797 j = inb(dev->baseport + 0x29) & 0xfe;
798 outb(j, dev->baseport + 0x29);
799 dev->r1f[c][scmd_id(workreq)] = 0;
800 }
801
802 if (workreq->cmnd[0] == READ_CAPACITY) {
803 if (workreq->request_bufflen > 8) {
804 workreq->request_bufflen = 0x08;
805 }
806 }
807 if (workreq->cmnd[0] == 0x00) {
808 workreq->request_bufflen = 0;
809 }
810
811 tmport = workport + 0x1b;
812 j = 0;
813 target_id = scmd_id(workreq);
814
815 /*
816 * Wide ?
817 */
818 w = 1;
819 w = w << target_id;
820 if ((w & dev->wide_id[c]) != 0) {
821 j |= 0x01;
822 }
823 outb(j, tmport);
824 while ((inb(tmport) & 0x01) != j) {
825 outb(j,tmport);
826 #ifdef ED_DBGP
827 printk("send_s870 while loop 1\n");
828 #endif
829 }
830 /*
831 * Write the command
832 */
833
834 tmport = workport;
835 outb(workreq->cmd_len, tmport++);
836 outb(0x2c, tmport++);
837 if (dev->dev_id == ATP885_DEVID) {
838 outb(0x7f, tmport++);
839 } else {
840 outb(0xcf, tmport++);
841 }
842 for (i = 0; i < workreq->cmd_len; i++) {
843 outb(workreq->cmnd[i], tmport++);
844 }
845 tmport = workport + 0x0f;
846 outb(workreq->device->lun, tmport);
847 tmport += 0x02;
848 /*
849 * Write the target
850 */
851 outb(dev->id[c][target_id].devsp, tmport++);
852 #ifdef ED_DBGP
853 printk("dev->id[%d][%d].devsp = %2x\n",c,target_id,dev->id[c][target_id].devsp);
854 #endif
855 /*
856 * Figure out the transfer size
857 */
858 if (workreq->use_sg) {
859 #ifdef ED_DBGP
860 printk("Using SGL\n");
861 #endif
862 l = 0;
863
864 sgpnt = (struct scatterlist *) workreq->request_buffer;
865 sg_count = pci_map_sg(dev->pdev, sgpnt, workreq->use_sg,
866 workreq->sc_data_direction);
867
868 for (i = 0; i < workreq->use_sg; i++) {
869 if (sgpnt[i].length == 0 || workreq->use_sg > ATP870U_SCATTER) {
870 panic("Foooooooood fight!");
871 }
872 l += sgpnt[i].length;
873 }
874 #ifdef ED_DBGP
875 printk( "send_s870: workreq->use_sg %d, sg_count %d l %8ld\n", workreq->use_sg, sg_count, l);
876 #endif
877 } else if(workreq->request_bufflen && workreq->sc_data_direction != PCI_DMA_NONE) {
878 #ifdef ED_DBGP
879 printk("Not using SGL\n");
880 #endif
881 workreq->SCp.dma_handle = pci_map_single(dev->pdev, workreq->request_buffer,
882 workreq->request_bufflen,
883 workreq->sc_data_direction);
884 l = workreq->request_bufflen;
885 #ifdef ED_DBGP
886 printk( "send_s870: workreq->use_sg %d, l %8ld\n", workreq->use_sg, l);
887 #endif
888 } else l = 0;
889 /*
890 * Write transfer size
891 */
892 outb((unsigned char) (((unsigned char *) (&l))[2]), tmport++);
893 outb((unsigned char) (((unsigned char *) (&l))[1]), tmport++);
894 outb((unsigned char) (((unsigned char *) (&l))[0]), tmport++);
895 j = target_id;
896 dev->id[c][j].last_len = l;
897 dev->id[c][j].tran_len = 0;
898 #ifdef ED_DBGP
899 printk("dev->id[%2d][%2d].last_len = %d\n",c,j,dev->id[c][j].last_len);
900 #endif
901 /*
902 * Flip the wide bits
903 */
904 if ((j & 0x08) != 0) {
905 j = (j & 0x07) | 0x40;
906 }
907 /*
908 * Check transfer direction
909 */
910 if (workreq->sc_data_direction == DMA_TO_DEVICE) {
911 outb((unsigned char) (j | 0x20), tmport++);
912 } else {
913 outb(j, tmport++);
914 }
915 outb((unsigned char) (inb(tmport) | 0x80), tmport);
916 outb(0x80, tmport);
917 tmport = workport + 0x1c;
918 dev->id[c][target_id].dirct = 0;
919 if (l == 0) {
920 if (inb(tmport) == 0) {
921 tmport = workport + 0x18;
922 #ifdef ED_DBGP
923 printk("change SCSI_CMD_REG 0x08\n");
924 #endif
925 outb(0x08, tmport);
926 } else {
927 dev->last_cmd[c] |= 0x40;
928 }
929 dev->in_snd[c] = 0;
930 return;
931 }
932 tmpcip = dev->pciport[c];
933 prd = dev->id[c][target_id].prd_table;
934 dev->id[c][target_id].prd_pos = prd;
935
936 /*
937 * Now write the request list. Either as scatter/gather or as
938 * a linear chain.
939 */
940
941 if (workreq->use_sg) {
942 sgpnt = (struct scatterlist *) workreq->request_buffer;
943 i = 0;
944 for (j = 0; j < workreq->use_sg; j++) {
945 bttl = sg_dma_address(&sgpnt[j]);
946 l=sg_dma_len(&sgpnt[j]);
947 #ifdef ED_DBGP
948 printk("1. bttl %x, l %x\n",bttl, l);
949 #endif
950 while (l > 0x10000) {
951 (((u16 *) (prd))[i + 3]) = 0x0000;
952 (((u16 *) (prd))[i + 2]) = 0x0000;
953 (((u32 *) (prd))[i >> 1]) = cpu_to_le32(bttl);
954 l -= 0x10000;
955 bttl += 0x10000;
956 i += 0x04;
957 }
958 (((u32 *) (prd))[i >> 1]) = cpu_to_le32(bttl);
959 (((u16 *) (prd))[i + 2]) = cpu_to_le16(l);
960 (((u16 *) (prd))[i + 3]) = 0;
961 i += 0x04;
962 }
963 (((u16 *) (prd))[i - 1]) = cpu_to_le16(0x8000);
964 #ifdef ED_DBGP
965 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]));
966 printk("2. bttl %x, l %x\n",bttl, l);
967 #endif
968 } else {
969 /*
970 * For a linear request write a chain of blocks
971 */
972 bttl = workreq->SCp.dma_handle;
973 l = workreq->request_bufflen;
974 i = 0;
975 #ifdef ED_DBGP
976 printk("3. bttl %x, l %x\n",bttl, l);
977 #endif
978 while (l > 0x10000) {
979 (((u16 *) (prd))[i + 3]) = 0x0000;
980 (((u16 *) (prd))[i + 2]) = 0x0000;
981 (((u32 *) (prd))[i >> 1]) = cpu_to_le32(bttl);
982 l -= 0x10000;
983 bttl += 0x10000;
984 i += 0x04;
985 }
986 (((u16 *) (prd))[i + 3]) = cpu_to_le16(0x8000);
987 (((u16 *) (prd))[i + 2]) = cpu_to_le16(l);
988 (((u32 *) (prd))[i >> 1]) = cpu_to_le32(bttl);
989 #ifdef ED_DBGP
990 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]));
991 printk("4. bttl %x, l %x\n",bttl, l);
992 #endif
993
994 }
995 tmpcip += 4;
996 #ifdef ED_DBGP
997 printk("send_s870: prdaddr_2 0x%8x tmpcip %x target_id %d\n", dev->id[c][target_id].prdaddr,tmpcip,target_id);
998 #endif
999 dev->id[c][target_id].prdaddr = dev->id[c][target_id].prd_bus;
1000 outl(dev->id[c][target_id].prdaddr, tmpcip);
1001 tmpcip = tmpcip - 2;
1002 outb(0x06, tmpcip);
1003 outb(0x00, tmpcip);
1004 if (dev->dev_id == ATP885_DEVID) {
1005 tmpcip--;
1006 j=inb(tmpcip) & 0xf3;
1007 if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) ||
1008 (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
1009 j |= 0x0c;
1010 }
1011 outb(j,tmpcip);
1012 tmpcip--;
1013 } else if ((dev->dev_id == ATP880_DEVID1) ||
1014 (dev->dev_id == ATP880_DEVID2)) {
1015 tmpcip =tmpcip -2;
1016 tmport = workport - 0x05;
1017 if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
1018 outb((unsigned char) ((inb(tmport) & 0x3f) | 0xc0), tmport);
1019 } else {
1020 outb((unsigned char) (inb(tmport) & 0x3f), tmport);
1021 }
1022 } else {
1023 tmpcip =tmpcip -2;
1024 tmport = workport + 0x3a;
1025 if ((workreq->cmnd[0] == 0x08) || (workreq->cmnd[0] == 0x28) || (workreq->cmnd[0] == 0x0a) || (workreq->cmnd[0] == 0x2a)) {
1026 outb((inb(tmport) & 0xf3) | 0x08, tmport);
1027 } else {
1028 outb(inb(tmport) & 0xf3, tmport);
1029 }
1030 }
1031 tmport = workport + 0x1c;
1032
1033 if(workreq->sc_data_direction == DMA_TO_DEVICE) {
1034 dev->id[c][target_id].dirct = 0x20;
1035 if (inb(tmport) == 0) {
1036 tmport = workport + 0x18;
1037 outb(0x08, tmport);
1038 outb(0x01, tmpcip);
1039 #ifdef ED_DBGP
1040 printk( "start DMA(to target)\n");
1041 #endif
1042 } else {
1043 dev->last_cmd[c] |= 0x40;
1044 }
1045 dev->in_snd[c] = 0;
1046 return;
1047 }
1048 if (inb(tmport) == 0) {
1049 tmport = workport + 0x18;
1050 outb(0x08, tmport);
1051 outb(0x09, tmpcip);
1052 #ifdef ED_DBGP
1053 printk( "start DMA(to host)\n");
1054 #endif
1055 } else {
1056 dev->last_cmd[c] |= 0x40;
1057 }
1058 dev->in_snd[c] = 0;
1059 return;
1060
1061 }
1062
1063 static unsigned char fun_scam(struct atp_unit *dev, unsigned short int *val)
1064 {
1065 unsigned int tmport;
1066 unsigned short int i, k;
1067 unsigned char j;
1068
1069 tmport = dev->ioport[0] + 0x1c;
1070 outw(*val, tmport);
1071 FUN_D7:
1072 for (i = 0; i < 10; i++) { /* stable >= bus settle delay(400 ns) */
1073 k = inw(tmport);
1074 j = (unsigned char) (k >> 8);
1075 if ((k & 0x8000) != 0) { /* DB7 all release? */
1076 goto FUN_D7;
1077 }
1078 }
1079 *val |= 0x4000; /* assert DB6 */
1080 outw(*val, tmport);
1081 *val &= 0xdfff; /* assert DB5 */
1082 outw(*val, tmport);
1083 FUN_D5:
1084 for (i = 0; i < 10; i++) { /* stable >= bus settle delay(400 ns) */
1085 if ((inw(tmport) & 0x2000) != 0) { /* DB5 all release? */
1086 goto FUN_D5;
1087 }
1088 }
1089 *val |= 0x8000; /* no DB4-0, assert DB7 */
1090 *val &= 0xe0ff;
1091 outw(*val, tmport);
1092 *val &= 0xbfff; /* release DB6 */
1093 outw(*val, tmport);
1094 FUN_D6:
1095 for (i = 0; i < 10; i++) { /* stable >= bus settle delay(400 ns) */
1096 if ((inw(tmport) & 0x4000) != 0) { /* DB6 all release? */
1097 goto FUN_D6;
1098 }
1099 }
1100
1101 return j;
1102 }
1103
1104 static void tscam(struct Scsi_Host *host)
1105 {
1106
1107 unsigned int tmport;
1108 unsigned char i, j, k;
1109 unsigned long n;
1110 unsigned short int m, assignid_map, val;
1111 unsigned char mbuf[33], quintet[2];
1112 struct atp_unit *dev = (struct atp_unit *)&host->hostdata;
1113 static unsigned char g2q_tab[8] = {
1114 0x38, 0x31, 0x32, 0x2b, 0x34, 0x2d, 0x2e, 0x27
1115 };
1116
1117 /* I can't believe we need this before we've even done anything. Remove it
1118 * and see if anyone bitches.
1119 for (i = 0; i < 0x10; i++) {
1120 udelay(0xffff);
1121 }
1122 */
1123
1124 tmport = dev->ioport[0] + 1;
1125 outb(0x08, tmport++);
1126 outb(0x7f, tmport);
1127 tmport = dev->ioport[0] + 0x11;
1128 outb(0x20, tmport);
1129
1130 if ((dev->scam_on & 0x40) == 0) {
1131 return;
1132 }
1133 m = 1;
1134 m <<= dev->host_id[0];
1135 j = 16;
1136 if (dev->chip_ver < 4) {
1137 m |= 0xff00;
1138 j = 8;
1139 }
1140 assignid_map = m;
1141 tmport = dev->ioport[0] + 0x02;
1142 outb(0x02, tmport++); /* 2*2=4ms,3EH 2/32*3E=3.9ms */
1143 outb(0, tmport++);
1144 outb(0, tmport++);
1145 outb(0, tmport++);
1146 outb(0, tmport++);
1147 outb(0, tmport++);
1148 outb(0, tmport++);
1149
1150 for (i = 0; i < j; i++) {
1151 m = 1;
1152 m = m << i;
1153 if ((m & assignid_map) != 0) {
1154 continue;
1155 }
1156 tmport = dev->ioport[0] + 0x0f;
1157 outb(0, tmport++);
1158 tmport += 0x02;
1159 outb(0, tmport++);
1160 outb(0, tmport++);
1161 outb(0, tmport++);
1162 if (i > 7) {
1163 k = (i & 0x07) | 0x40;
1164 } else {
1165 k = i;
1166 }
1167 outb(k, tmport++);
1168 tmport = dev->ioport[0] + 0x1b;
1169 if (dev->chip_ver == 4) {
1170 outb(0x01, tmport);
1171 } else {
1172 outb(0x00, tmport);
1173 }
1174 wait_rdyok:
1175 tmport = dev->ioport[0] + 0x18;
1176 outb(0x09, tmport);
1177 tmport += 0x07;
1178
1179 while ((inb(tmport) & 0x80) == 0x00)
1180 cpu_relax();
1181 tmport -= 0x08;
1182 k = inb(tmport);
1183 if (k != 0x16) {
1184 if ((k == 0x85) || (k == 0x42)) {
1185 continue;
1186 }
1187 tmport = dev->ioport[0] + 0x10;
1188 outb(0x41, tmport);
1189 goto wait_rdyok;
1190 }
1191 assignid_map |= m;
1192
1193 }
1194 tmport = dev->ioport[0] + 0x02;
1195 outb(0x7f, tmport);
1196 tmport = dev->ioport[0] + 0x1b;
1197 outb(0x02, tmport);
1198
1199 outb(0, 0x80);
1200
1201 val = 0x0080; /* bsy */
1202 tmport = dev->ioport[0] + 0x1c;
1203 outw(val, tmport);
1204 val |= 0x0040; /* sel */
1205 outw(val, tmport);
1206 val |= 0x0004; /* msg */
1207 outw(val, tmport);
1208 inb(0x80); /* 2 deskew delay(45ns*2=90ns) */
1209 val &= 0x007f; /* no bsy */
1210 outw(val, tmport);
1211 mdelay(128);
1212 val &= 0x00fb; /* after 1ms no msg */
1213 outw(val, tmport);
1214 wait_nomsg:
1215 if ((inb(tmport) & 0x04) != 0) {
1216 goto wait_nomsg;
1217 }
1218 outb(1, 0x80);
1219 udelay(100);
1220 for (n = 0; n < 0x30000; n++) {
1221 if ((inb(tmport) & 0x80) != 0) { /* bsy ? */
1222 goto wait_io;
1223 }
1224 }
1225 goto TCM_SYNC;
1226 wait_io:
1227 for (n = 0; n < 0x30000; n++) {
1228 if ((inb(tmport) & 0x81) == 0x0081) {
1229 goto wait_io1;
1230 }
1231 }
1232 goto TCM_SYNC;
1233 wait_io1:
1234 inb(0x80);
1235 val |= 0x8003; /* io,cd,db7 */
1236 outw(val, tmport);
1237 inb(0x80);
1238 val &= 0x00bf; /* no sel */
1239 outw(val, tmport);
1240 outb(2, 0x80);
1241 TCM_SYNC:
1242 udelay(0x800);
1243 if ((inb(tmport) & 0x80) == 0x00) { /* bsy ? */
1244 outw(0, tmport--);
1245 outb(0, tmport);
1246 tmport = dev->ioport[0] + 0x15;
1247 outb(0, tmport);
1248 tmport += 0x03;
1249 outb(0x09, tmport);
1250 tmport += 0x07;
1251 while ((inb(tmport) & 0x80) == 0)
1252 cpu_relax();
1253 tmport -= 0x08;
1254 inb(tmport);
1255 return;
1256 }
1257 val &= 0x00ff; /* synchronization */
1258 val |= 0x3f00;
1259 fun_scam(dev, &val);
1260 outb(3, 0x80);
1261 val &= 0x00ff; /* isolation */
1262 val |= 0x2000;
1263 fun_scam(dev, &val);
1264 outb(4, 0x80);
1265 i = 8;
1266 j = 0;
1267 TCM_ID:
1268 if ((inw(tmport) & 0x2000) == 0) {
1269 goto TCM_ID;
1270 }
1271 outb(5, 0x80);
1272 val &= 0x00ff; /* get ID_STRING */
1273 val |= 0x2000;
1274 k = fun_scam(dev, &val);
1275 if ((k & 0x03) == 0) {
1276 goto TCM_5;
1277 }
1278 mbuf[j] <<= 0x01;
1279 mbuf[j] &= 0xfe;
1280 if ((k & 0x02) != 0) {
1281 mbuf[j] |= 0x01;
1282 }
1283 i--;
1284 if (i > 0) {
1285 goto TCM_ID;
1286 }
1287 j++;
1288 i = 8;
1289 goto TCM_ID;
1290
1291 TCM_5: /* isolation complete.. */
1292 /* mbuf[32]=0;
1293 printk(" \n%x %x %x %s\n ",assignid_map,mbuf[0],mbuf[1],&mbuf[2]); */
1294 i = 15;
1295 j = mbuf[0];
1296 if ((j & 0x20) != 0) { /* bit5=1:ID upto 7 */
1297 i = 7;
1298 }
1299 if ((j & 0x06) == 0) { /* IDvalid? */
1300 goto G2Q5;
1301 }
1302 k = mbuf[1];
1303 small_id:
1304 m = 1;
1305 m <<= k;
1306 if ((m & assignid_map) == 0) {
1307 goto G2Q_QUIN;
1308 }
1309 if (k > 0) {
1310 k--;
1311 goto small_id;
1312 }
1313 G2Q5: /* srch from max acceptable ID# */
1314 k = i; /* max acceptable ID# */
1315 G2Q_LP:
1316 m = 1;
1317 m <<= k;
1318 if ((m & assignid_map) == 0) {
1319 goto G2Q_QUIN;
1320 }
1321 if (k > 0) {
1322 k--;
1323 goto G2Q_LP;
1324 }
1325 G2Q_QUIN: /* k=binID#, */
1326 assignid_map |= m;
1327 if (k < 8) {
1328 quintet[0] = 0x38; /* 1st dft ID<8 */
1329 } else {
1330 quintet[0] = 0x31; /* 1st ID>=8 */
1331 }
1332 k &= 0x07;
1333 quintet[1] = g2q_tab[k];
1334
1335 val &= 0x00ff; /* AssignID 1stQuintet,AH=001xxxxx */
1336 m = quintet[0] << 8;
1337 val |= m;
1338 fun_scam(dev, &val);
1339 val &= 0x00ff; /* AssignID 2ndQuintet,AH=001xxxxx */
1340 m = quintet[1] << 8;
1341 val |= m;
1342 fun_scam(dev, &val);
1343
1344 goto TCM_SYNC;
1345
1346 }
1347
1348 static void is870(struct atp_unit *dev, unsigned int wkport)
1349 {
1350 unsigned int tmport;
1351 unsigned char i, j, k, rmb, n;
1352 unsigned short int m;
1353 static unsigned char mbuf[512];
1354 static unsigned char satn[9] = { 0, 0, 0, 0, 0, 0, 0, 6, 6 };
1355 static unsigned char inqd[9] = { 0x12, 0, 0, 0, 0x24, 0, 0, 0x24, 6 };
1356 static unsigned char synn[6] = { 0x80, 1, 3, 1, 0x19, 0x0e };
1357 static unsigned char synu[6] = { 0x80, 1, 3, 1, 0x0c, 0x0e };
1358 static unsigned char synw[6] = { 0x80, 1, 3, 1, 0x0c, 0x07 };
1359 static unsigned char wide[6] = { 0x80, 1, 2, 3, 1, 0 };
1360
1361 tmport = wkport + 0x3a;
1362 outb((unsigned char) (inb(tmport) | 0x10), tmport);
1363
1364 for (i = 0; i < 16; i++) {
1365 if ((dev->chip_ver != 4) && (i > 7)) {
1366 break;
1367 }
1368 m = 1;
1369 m = m << i;
1370 if ((m & dev->active_id[0]) != 0) {
1371 continue;
1372 }
1373 if (i == dev->host_id[0]) {
1374 printk(KERN_INFO " ID: %2d Host Adapter\n", dev->host_id[0]);
1375 continue;
1376 }
1377 tmport = wkport + 0x1b;
1378 if (dev->chip_ver == 4) {
1379 outb(0x01, tmport);
1380 } else {
1381 outb(0x00, tmport);
1382 }
1383 tmport = wkport + 1;
1384 outb(0x08, tmport++);
1385 outb(0x7f, tmport++);
1386 outb(satn[0], tmport++);
1387 outb(satn[1], tmport++);
1388 outb(satn[2], tmport++);
1389 outb(satn[3], tmport++);
1390 outb(satn[4], tmport++);
1391 outb(satn[5], tmport++);
1392 tmport += 0x06;
1393 outb(0, tmport);
1394 tmport += 0x02;
1395 outb(dev->id[0][i].devsp, tmport++);
1396 outb(0, tmport++);
1397 outb(satn[6], tmport++);
1398 outb(satn[7], tmport++);
1399 j = i;
1400 if ((j & 0x08) != 0) {
1401 j = (j & 0x07) | 0x40;
1402 }
1403 outb(j, tmport);
1404 tmport += 0x03;
1405 outb(satn[8], tmport);
1406 tmport += 0x07;
1407
1408 while ((inb(tmport) & 0x80) == 0x00)
1409 cpu_relax();
1410
1411 tmport -= 0x08;
1412 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
1413 continue;
1414
1415 while (inb(tmport) != 0x8e)
1416 cpu_relax();
1417
1418 dev->active_id[0] |= m;
1419
1420 tmport = wkport + 0x10;
1421 outb(0x30, tmport);
1422 tmport = wkport + 0x04;
1423 outb(0x00, tmport);
1424
1425 phase_cmd:
1426 tmport = wkport + 0x18;
1427 outb(0x08, tmport);
1428 tmport += 0x07;
1429 while ((inb(tmport) & 0x80) == 0x00)
1430 cpu_relax();
1431 tmport -= 0x08;
1432 j = inb(tmport);
1433 if (j != 0x16) {
1434 tmport = wkport + 0x10;
1435 outb(0x41, tmport);
1436 goto phase_cmd;
1437 }
1438 sel_ok:
1439 tmport = wkport + 3;
1440 outb(inqd[0], tmport++);
1441 outb(inqd[1], tmport++);
1442 outb(inqd[2], tmport++);
1443 outb(inqd[3], tmport++);
1444 outb(inqd[4], tmport++);
1445 outb(inqd[5], tmport);
1446 tmport += 0x07;
1447 outb(0, tmport);
1448 tmport += 0x02;
1449 outb(dev->id[0][i].devsp, tmport++);
1450 outb(0, tmport++);
1451 outb(inqd[6], tmport++);
1452 outb(inqd[7], tmport++);
1453 tmport += 0x03;
1454 outb(inqd[8], tmport);
1455 tmport += 0x07;
1456
1457 while ((inb(tmport) & 0x80) == 0x00)
1458 cpu_relax();
1459
1460 tmport -= 0x08;
1461 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
1462 continue;
1463
1464 while (inb(tmport) != 0x8e)
1465 cpu_relax();
1466
1467 tmport = wkport + 0x1b;
1468 if (dev->chip_ver == 4)
1469 outb(0x00, tmport);
1470
1471 tmport = wkport + 0x18;
1472 outb(0x08, tmport);
1473 tmport += 0x07;
1474 j = 0;
1475 rd_inq_data:
1476 k = inb(tmport);
1477 if ((k & 0x01) != 0) {
1478 tmport -= 0x06;
1479 mbuf[j++] = inb(tmport);
1480 tmport += 0x06;
1481 goto rd_inq_data;
1482 }
1483 if ((k & 0x80) == 0) {
1484 goto rd_inq_data;
1485 }
1486 tmport -= 0x08;
1487 j = inb(tmport);
1488 if (j == 0x16) {
1489 goto inq_ok;
1490 }
1491 tmport = wkport + 0x10;
1492 outb(0x46, tmport);
1493 tmport += 0x02;
1494 outb(0, tmport++);
1495 outb(0, tmport++);
1496 outb(0, tmport++);
1497 tmport += 0x03;
1498 outb(0x08, tmport);
1499 tmport += 0x07;
1500
1501 while ((inb(tmport) & 0x80) == 0x00)
1502 cpu_relax();
1503
1504 tmport -= 0x08;
1505 if (inb(tmport) != 0x16) {
1506 goto sel_ok;
1507 }
1508 inq_ok:
1509 mbuf[36] = 0;
1510 printk(KERN_INFO " ID: %2d %s\n", i, &mbuf[8]);
1511 dev->id[0][i].devtype = mbuf[0];
1512 rmb = mbuf[1];
1513 n = mbuf[7];
1514 if (dev->chip_ver != 4) {
1515 goto not_wide;
1516 }
1517 if ((mbuf[7] & 0x60) == 0) {
1518 goto not_wide;
1519 }
1520 if ((dev->global_map[0] & 0x20) == 0) {
1521 goto not_wide;
1522 }
1523 tmport = wkport + 0x1b;
1524 outb(0x01, tmport);
1525 tmport = wkport + 3;
1526 outb(satn[0], tmport++);
1527 outb(satn[1], tmport++);
1528 outb(satn[2], tmport++);
1529 outb(satn[3], tmport++);
1530 outb(satn[4], tmport++);
1531 outb(satn[5], tmport++);
1532 tmport += 0x06;
1533 outb(0, tmport);
1534 tmport += 0x02;
1535 outb(dev->id[0][i].devsp, tmport++);
1536 outb(0, tmport++);
1537 outb(satn[6], tmport++);
1538 outb(satn[7], tmport++);
1539 tmport += 0x03;
1540 outb(satn[8], tmport);
1541 tmport += 0x07;
1542
1543 while ((inb(tmport) & 0x80) == 0x00)
1544 cpu_relax();
1545
1546 tmport -= 0x08;
1547 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
1548 continue;
1549
1550 while (inb(tmport) != 0x8e)
1551 cpu_relax();
1552
1553 try_wide:
1554 j = 0;
1555 tmport = wkport + 0x14;
1556 outb(0x05, tmport);
1557 tmport += 0x04;
1558 outb(0x20, tmport);
1559 tmport += 0x07;
1560
1561 while ((inb(tmport) & 0x80) == 0) {
1562 if ((inb(tmport) & 0x01) != 0) {
1563 tmport -= 0x06;
1564 outb(wide[j++], tmport);
1565 tmport += 0x06;
1566 }
1567 }
1568 tmport -= 0x08;
1569
1570 while ((inb(tmport) & 0x80) == 0x00)
1571 cpu_relax();
1572
1573 j = inb(tmport) & 0x0f;
1574 if (j == 0x0f) {
1575 goto widep_in;
1576 }
1577 if (j == 0x0a) {
1578 goto widep_cmd;
1579 }
1580 if (j == 0x0e) {
1581 goto try_wide;
1582 }
1583 continue;
1584 widep_out:
1585 tmport = wkport + 0x18;
1586 outb(0x20, tmport);
1587 tmport += 0x07;
1588 while ((inb(tmport) & 0x80) == 0) {
1589 if ((inb(tmport) & 0x01) != 0) {
1590 tmport -= 0x06;
1591 outb(0, tmport);
1592 tmport += 0x06;
1593 }
1594 }
1595 tmport -= 0x08;
1596 j = inb(tmport) & 0x0f;
1597 if (j == 0x0f) {
1598 goto widep_in;
1599 }
1600 if (j == 0x0a) {
1601 goto widep_cmd;
1602 }
1603 if (j == 0x0e) {
1604 goto widep_out;
1605 }
1606 continue;
1607 widep_in:
1608 tmport = wkport + 0x14;
1609 outb(0xff, tmport);
1610 tmport += 0x04;
1611 outb(0x20, tmport);
1612 tmport += 0x07;
1613 k = 0;
1614 widep_in1:
1615 j = inb(tmport);
1616 if ((j & 0x01) != 0) {
1617 tmport -= 0x06;
1618 mbuf[k++] = inb(tmport);
1619 tmport += 0x06;
1620 goto widep_in1;
1621 }
1622 if ((j & 0x80) == 0x00) {
1623 goto widep_in1;
1624 }
1625 tmport -= 0x08;
1626 j = inb(tmport) & 0x0f;
1627 if (j == 0x0f) {
1628 goto widep_in;
1629 }
1630 if (j == 0x0a) {
1631 goto widep_cmd;
1632 }
1633 if (j == 0x0e) {
1634 goto widep_out;
1635 }
1636 continue;
1637 widep_cmd:
1638 tmport = wkport + 0x10;
1639 outb(0x30, tmport);
1640 tmport = wkport + 0x14;
1641 outb(0x00, tmport);
1642 tmport += 0x04;
1643 outb(0x08, tmport);
1644 tmport += 0x07;
1645
1646 while ((inb(tmport) & 0x80) == 0x00)
1647 cpu_relax();
1648
1649 tmport -= 0x08;
1650 j = inb(tmport);
1651 if (j != 0x16) {
1652 if (j == 0x4e) {
1653 goto widep_out;
1654 }
1655 continue;
1656 }
1657 if (mbuf[0] != 0x01) {
1658 goto not_wide;
1659 }
1660 if (mbuf[1] != 0x02) {
1661 goto not_wide;
1662 }
1663 if (mbuf[2] != 0x03) {
1664 goto not_wide;
1665 }
1666 if (mbuf[3] != 0x01) {
1667 goto not_wide;
1668 }
1669 m = 1;
1670 m = m << i;
1671 dev->wide_id[0] |= m;
1672 not_wide:
1673 if ((dev->id[0][i].devtype == 0x00) || (dev->id[0][i].devtype == 0x07) || ((dev->id[0][i].devtype == 0x05) && ((n & 0x10) != 0))) {
1674 goto set_sync;
1675 }
1676 continue;
1677 set_sync:
1678 tmport = wkport + 0x1b;
1679 j = 0;
1680 if ((m & dev->wide_id[0]) != 0) {
1681 j |= 0x01;
1682 }
1683 outb(j, tmport);
1684 tmport = wkport + 3;
1685 outb(satn[0], tmport++);
1686 outb(satn[1], tmport++);
1687 outb(satn[2], tmport++);
1688 outb(satn[3], tmport++);
1689 outb(satn[4], tmport++);
1690 outb(satn[5], tmport++);
1691 tmport += 0x06;
1692 outb(0, tmport);
1693 tmport += 0x02;
1694 outb(dev->id[0][i].devsp, tmport++);
1695 outb(0, tmport++);
1696 outb(satn[6], tmport++);
1697 outb(satn[7], tmport++);
1698 tmport += 0x03;
1699 outb(satn[8], tmport);
1700 tmport += 0x07;
1701
1702 while ((inb(tmport) & 0x80) == 0x00)
1703 cpu_relax();
1704
1705 tmport -= 0x08;
1706 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
1707 continue;
1708
1709 while (inb(tmport) != 0x8e)
1710 cpu_relax();
1711
1712 try_sync:
1713 j = 0;
1714 tmport = wkport + 0x14;
1715 outb(0x06, tmport);
1716 tmport += 0x04;
1717 outb(0x20, tmport);
1718 tmport += 0x07;
1719
1720 while ((inb(tmport) & 0x80) == 0) {
1721 if ((inb(tmport) & 0x01) != 0) {
1722 tmport -= 0x06;
1723 if ((m & dev->wide_id[0]) != 0) {
1724 outb(synw[j++], tmport);
1725 } else {
1726 if ((m & dev->ultra_map[0]) != 0) {
1727 outb(synu[j++], tmport);
1728 } else {
1729 outb(synn[j++], tmport);
1730 }
1731 }
1732 tmport += 0x06;
1733 }
1734 }
1735 tmport -= 0x08;
1736
1737 while ((inb(tmport) & 0x80) == 0x00)
1738 cpu_relax();
1739
1740 j = inb(tmport) & 0x0f;
1741 if (j == 0x0f) {
1742 goto phase_ins;
1743 }
1744 if (j == 0x0a) {
1745 goto phase_cmds;
1746 }
1747 if (j == 0x0e) {
1748 goto try_sync;
1749 }
1750 continue;
1751 phase_outs:
1752 tmport = wkport + 0x18;
1753 outb(0x20, tmport);
1754 tmport += 0x07;
1755 while ((inb(tmport) & 0x80) == 0x00) {
1756 if ((inb(tmport) & 0x01) != 0x00) {
1757 tmport -= 0x06;
1758 outb(0x00, tmport);
1759 tmport += 0x06;
1760 }
1761 }
1762 tmport -= 0x08;
1763 j = inb(tmport);
1764 if (j == 0x85) {
1765 goto tar_dcons;
1766 }
1767 j &= 0x0f;
1768 if (j == 0x0f) {
1769 goto phase_ins;
1770 }
1771 if (j == 0x0a) {
1772 goto phase_cmds;
1773 }
1774 if (j == 0x0e) {
1775 goto phase_outs;
1776 }
1777 continue;
1778 phase_ins:
1779 tmport = wkport + 0x14;
1780 outb(0xff, tmport);
1781 tmport += 0x04;
1782 outb(0x20, tmport);
1783 tmport += 0x07;
1784 k = 0;
1785 phase_ins1:
1786 j = inb(tmport);
1787 if ((j & 0x01) != 0x00) {
1788 tmport -= 0x06;
1789 mbuf[k++] = inb(tmport);
1790 tmport += 0x06;
1791 goto phase_ins1;
1792 }
1793 if ((j & 0x80) == 0x00) {
1794 goto phase_ins1;
1795 }
1796 tmport -= 0x08;
1797
1798 while ((inb(tmport) & 0x80) == 0x00)
1799 cpu_relax();
1800
1801 j = inb(tmport);
1802 if (j == 0x85) {
1803 goto tar_dcons;
1804 }
1805 j &= 0x0f;
1806 if (j == 0x0f) {
1807 goto phase_ins;
1808 }
1809 if (j == 0x0a) {
1810 goto phase_cmds;
1811 }
1812 if (j == 0x0e) {
1813 goto phase_outs;
1814 }
1815 continue;
1816 phase_cmds:
1817 tmport = wkport + 0x10;
1818 outb(0x30, tmport);
1819 tar_dcons:
1820 tmport = wkport + 0x14;
1821 outb(0x00, tmport);
1822 tmport += 0x04;
1823 outb(0x08, tmport);
1824 tmport += 0x07;
1825
1826 while ((inb(tmport) & 0x80) == 0x00)
1827 cpu_relax();
1828
1829 tmport -= 0x08;
1830 j = inb(tmport);
1831 if (j != 0x16) {
1832 continue;
1833 }
1834 if (mbuf[0] != 0x01) {
1835 continue;
1836 }
1837 if (mbuf[1] != 0x03) {
1838 continue;
1839 }
1840 if (mbuf[4] == 0x00) {
1841 continue;
1842 }
1843 if (mbuf[3] > 0x64) {
1844 continue;
1845 }
1846 if (mbuf[4] > 0x0c) {
1847 mbuf[4] = 0x0c;
1848 }
1849 dev->id[0][i].devsp = mbuf[4];
1850 if ((mbuf[3] < 0x0d) && (rmb == 0)) {
1851 j = 0xa0;
1852 goto set_syn_ok;
1853 }
1854 if (mbuf[3] < 0x1a) {
1855 j = 0x20;
1856 goto set_syn_ok;
1857 }
1858 if (mbuf[3] < 0x33) {
1859 j = 0x40;
1860 goto set_syn_ok;
1861 }
1862 if (mbuf[3] < 0x4c) {
1863 j = 0x50;
1864 goto set_syn_ok;
1865 }
1866 j = 0x60;
1867 set_syn_ok:
1868 dev->id[0][i].devsp = (dev->id[0][i].devsp & 0x0f) | j;
1869 }
1870 tmport = wkport + 0x3a;
1871 outb((unsigned char) (inb(tmport) & 0xef), tmport);
1872 }
1873
1874 static void is880(struct atp_unit *dev, unsigned int wkport)
1875 {
1876 unsigned int tmport;
1877 unsigned char i, j, k, rmb, n, lvdmode;
1878 unsigned short int m;
1879 static unsigned char mbuf[512];
1880 static unsigned char satn[9] = { 0, 0, 0, 0, 0, 0, 0, 6, 6 };
1881 static unsigned char inqd[9] = { 0x12, 0, 0, 0, 0x24, 0, 0, 0x24, 6 };
1882 static unsigned char synn[6] = { 0x80, 1, 3, 1, 0x19, 0x0e };
1883 unsigned char synu[6] = { 0x80, 1, 3, 1, 0x0a, 0x0e };
1884 static unsigned char synw[6] = { 0x80, 1, 3, 1, 0x19, 0x0e };
1885 unsigned char synuw[6] = { 0x80, 1, 3, 1, 0x0a, 0x0e };
1886 static unsigned char wide[6] = { 0x80, 1, 2, 3, 1, 0 };
1887 static unsigned char u3[9] = { 0x80, 1, 6, 4, 0x09, 00, 0x0e, 0x01, 0x02 };
1888
1889 lvdmode = inb(wkport + 0x3f) & 0x40;
1890
1891 for (i = 0; i < 16; i++) {
1892 m = 1;
1893 m = m << i;
1894 if ((m & dev->active_id[0]) != 0) {
1895 continue;
1896 }
1897 if (i == dev->host_id[0]) {
1898 printk(KERN_INFO " ID: %2d Host Adapter\n", dev->host_id[0]);
1899 continue;
1900 }
1901 tmport = wkport + 0x5b;
1902 outb(0x01, tmport);
1903 tmport = wkport + 0x41;
1904 outb(0x08, tmport++);
1905 outb(0x7f, tmport++);
1906 outb(satn[0], tmport++);
1907 outb(satn[1], tmport++);
1908 outb(satn[2], tmport++);
1909 outb(satn[3], tmport++);
1910 outb(satn[4], tmport++);
1911 outb(satn[5], tmport++);
1912 tmport += 0x06;
1913 outb(0, tmport);
1914 tmport += 0x02;
1915 outb(dev->id[0][i].devsp, tmport++);
1916 outb(0, tmport++);
1917 outb(satn[6], tmport++);
1918 outb(satn[7], tmport++);
1919 j = i;
1920 if ((j & 0x08) != 0) {
1921 j = (j & 0x07) | 0x40;
1922 }
1923 outb(j, tmport);
1924 tmport += 0x03;
1925 outb(satn[8], tmport);
1926 tmport += 0x07;
1927
1928 while ((inb(tmport) & 0x80) == 0x00)
1929 cpu_relax();
1930
1931 tmport -= 0x08;
1932 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
1933 continue;
1934
1935 while (inb(tmport) != 0x8e)
1936 cpu_relax();
1937
1938 dev->active_id[0] |= m;
1939
1940 tmport = wkport + 0x50;
1941 outb(0x30, tmport);
1942 tmport = wkport + 0x54;
1943 outb(0x00, tmport);
1944
1945 phase_cmd:
1946 tmport = wkport + 0x58;
1947 outb(0x08, tmport);
1948 tmport += 0x07;
1949
1950 while ((inb(tmport) & 0x80) == 0x00)
1951 cpu_relax();
1952
1953 tmport -= 0x08;
1954 j = inb(tmport);
1955 if (j != 0x16) {
1956 tmport = wkport + 0x50;
1957 outb(0x41, tmport);
1958 goto phase_cmd;
1959 }
1960 sel_ok:
1961 tmport = wkport + 0x43;
1962 outb(inqd[0], tmport++);
1963 outb(inqd[1], tmport++);
1964 outb(inqd[2], tmport++);
1965 outb(inqd[3], tmport++);
1966 outb(inqd[4], tmport++);
1967 outb(inqd[5], tmport);
1968 tmport += 0x07;
1969 outb(0, tmport);
1970 tmport += 0x02;
1971 outb(dev->id[0][i].devsp, tmport++);
1972 outb(0, tmport++);
1973 outb(inqd[6], tmport++);
1974 outb(inqd[7], tmport++);
1975 tmport += 0x03;
1976 outb(inqd[8], tmport);
1977 tmport += 0x07;
1978
1979 while ((inb(tmport) & 0x80) == 0x00)
1980 cpu_relax();
1981
1982 tmport -= 0x08;
1983 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
1984 continue;
1985
1986 while (inb(tmport) != 0x8e)
1987 cpu_relax();
1988
1989 tmport = wkport + 0x5b;
1990 outb(0x00, tmport);
1991 tmport = wkport + 0x58;
1992 outb(0x08, tmport);
1993 tmport += 0x07;
1994 j = 0;
1995 rd_inq_data:
1996 k = inb(tmport);
1997 if ((k & 0x01) != 0) {
1998 tmport -= 0x06;
1999 mbuf[j++] = inb(tmport);
2000 tmport += 0x06;
2001 goto rd_inq_data;
2002 }
2003 if ((k & 0x80) == 0) {
2004 goto rd_inq_data;
2005 }
2006 tmport -= 0x08;
2007 j = inb(tmport);
2008 if (j == 0x16) {
2009 goto inq_ok;
2010 }
2011 tmport = wkport + 0x50;
2012 outb(0x46, tmport);
2013 tmport += 0x02;
2014 outb(0, tmport++);
2015 outb(0, tmport++);
2016 outb(0, tmport++);
2017 tmport += 0x03;
2018 outb(0x08, tmport);
2019 tmport += 0x07;
2020 while ((inb(tmport) & 0x80) == 0x00)
2021 cpu_relax();
2022
2023 tmport -= 0x08;
2024 if (inb(tmport) != 0x16)
2025 goto sel_ok;
2026
2027 inq_ok:
2028 mbuf[36] = 0;
2029 printk(KERN_INFO " ID: %2d %s\n", i, &mbuf[8]);
2030 dev->id[0][i].devtype = mbuf[0];
2031 rmb = mbuf[1];
2032 n = mbuf[7];
2033 if ((mbuf[7] & 0x60) == 0) {
2034 goto not_wide;
2035 }
2036 if ((i < 8) && ((dev->global_map[0] & 0x20) == 0)) {
2037 goto not_wide;
2038 }
2039 if (lvdmode == 0) {
2040 goto chg_wide;
2041 }
2042 if (dev->sp[0][i] != 0x04) // force u2
2043 {
2044 goto chg_wide;
2045 }
2046
2047 tmport = wkport + 0x5b;
2048 outb(0x01, tmport);
2049 tmport = wkport + 0x43;
2050 outb(satn[0], tmport++);
2051 outb(satn[1], tmport++);
2052 outb(satn[2], tmport++);
2053 outb(satn[3], tmport++);
2054 outb(satn[4], tmport++);
2055 outb(satn[5], tmport++);
2056 tmport += 0x06;
2057 outb(0, tmport);
2058 tmport += 0x02;
2059 outb(dev->id[0][i].devsp, tmport++);
2060 outb(0, tmport++);
2061 outb(satn[6], tmport++);
2062 outb(satn[7], tmport++);
2063 tmport += 0x03;
2064 outb(satn[8], tmport);
2065 tmport += 0x07;
2066
2067 while ((inb(tmport) & 0x80) == 0x00)
2068 cpu_relax();
2069
2070 tmport -= 0x08;
2071
2072 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
2073 continue;
2074
2075 while (inb(tmport) != 0x8e)
2076 cpu_relax();
2077
2078 try_u3:
2079 j = 0;
2080 tmport = wkport + 0x54;
2081 outb(0x09, tmport);
2082 tmport += 0x04;
2083 outb(0x20, tmport);
2084 tmport += 0x07;
2085
2086 while ((inb(tmport) & 0x80) == 0) {
2087 if ((inb(tmport) & 0x01) != 0) {
2088 tmport -= 0x06;
2089 outb(u3[j++], tmport);
2090 tmport += 0x06;
2091 }
2092 }
2093 tmport -= 0x08;
2094
2095 while ((inb(tmport) & 0x80) == 0x00)
2096 cpu_relax();
2097
2098 j = inb(tmport) & 0x0f;
2099 if (j == 0x0f) {
2100 goto u3p_in;
2101 }
2102 if (j == 0x0a) {
2103 goto u3p_cmd;
2104 }
2105 if (j == 0x0e) {
2106 goto try_u3;
2107 }
2108 continue;
2109 u3p_out:
2110 tmport = wkport + 0x58;
2111 outb(0x20, tmport);
2112 tmport += 0x07;
2113 while ((inb(tmport) & 0x80) == 0) {
2114 if ((inb(tmport) & 0x01) != 0) {
2115 tmport -= 0x06;
2116 outb(0, tmport);
2117 tmport += 0x06;
2118 }
2119 }
2120 tmport -= 0x08;
2121 j = inb(tmport) & 0x0f;
2122 if (j == 0x0f) {
2123 goto u3p_in;
2124 }
2125 if (j == 0x0a) {
2126 goto u3p_cmd;
2127 }
2128 if (j == 0x0e) {
2129 goto u3p_out;
2130 }
2131 continue;
2132 u3p_in:
2133 tmport = wkport + 0x54;
2134 outb(0x09, tmport);
2135 tmport += 0x04;
2136 outb(0x20, tmport);
2137 tmport += 0x07;
2138 k = 0;
2139 u3p_in1:
2140 j = inb(tmport);
2141 if ((j & 0x01) != 0) {
2142 tmport -= 0x06;
2143 mbuf[k++] = inb(tmport);
2144 tmport += 0x06;
2145 goto u3p_in1;
2146 }
2147 if ((j & 0x80) == 0x00) {
2148 goto u3p_in1;
2149 }
2150 tmport -= 0x08;
2151 j = inb(tmport) & 0x0f;
2152 if (j == 0x0f) {
2153 goto u3p_in;
2154 }
2155 if (j == 0x0a) {
2156 goto u3p_cmd;
2157 }
2158 if (j == 0x0e) {
2159 goto u3p_out;
2160 }
2161 continue;
2162 u3p_cmd:
2163 tmport = wkport + 0x50;
2164 outb(0x30, tmport);
2165 tmport = wkport + 0x54;
2166 outb(0x00, tmport);
2167 tmport += 0x04;
2168 outb(0x08, tmport);
2169 tmport += 0x07;
2170
2171 while ((inb(tmport) & 0x80) == 0x00)
2172 cpu_relax();
2173
2174 tmport -= 0x08;
2175 j = inb(tmport);
2176 if (j != 0x16) {
2177 if (j == 0x4e) {
2178 goto u3p_out;
2179 }
2180 continue;
2181 }
2182 if (mbuf[0] != 0x01) {
2183 goto chg_wide;
2184 }
2185 if (mbuf[1] != 0x06) {
2186 goto chg_wide;
2187 }
2188 if (mbuf[2] != 0x04) {
2189 goto chg_wide;
2190 }
2191 if (mbuf[3] == 0x09) {
2192 m = 1;
2193 m = m << i;
2194 dev->wide_id[0] |= m;
2195 dev->id[0][i].devsp = 0xce;
2196 continue;
2197 }
2198 chg_wide:
2199 tmport = wkport + 0x5b;
2200 outb(0x01, tmport);
2201 tmport = wkport + 0x43;
2202 outb(satn[0], tmport++);
2203 outb(satn[1], tmport++);
2204 outb(satn[2], tmport++);
2205 outb(satn[3], tmport++);
2206 outb(satn[4], tmport++);
2207 outb(satn[5], tmport++);
2208 tmport += 0x06;
2209 outb(0, tmport);
2210 tmport += 0x02;
2211 outb(dev->id[0][i].devsp, tmport++);
2212 outb(0, tmport++);
2213 outb(satn[6], tmport++);
2214 outb(satn[7], tmport++);
2215 tmport += 0x03;
2216 outb(satn[8], tmport);
2217 tmport += 0x07;
2218
2219 while ((inb(tmport) & 0x80) == 0x00)
2220 cpu_relax();
2221
2222 tmport -= 0x08;
2223 if (inb(tmport) != 0x11 && inb(tmport) != 0x8e)
2224 continue;
2225
2226 while (inb(tmport) != 0x8e)
2227 cpu_relax();
2228
2229 try_wide:
2230 j = 0;
2231 tmport = wkport + 0x54;
2232 outb(0x05, tmport);
2233 tmport += 0x04;
2234 outb(0x20, tmport);
2235 tmport += 0x07;
2236
2237 while ((inb(tmport) & 0x80) == 0) {
2238 if ((inb(tmport) & 0x01) != 0) {
2239 tmport -= 0x06;
2240 outb(wide[j++], tmport);
2241 tmport += 0x06;
2242 }
2243 }
2244 tmport -= 0x08;
2245 while ((inb(tmport) & 0x80) == 0x00)
2246 cpu_relax();
2247
2248 j = inb(tmport) & 0x0f;
2249 if (j == 0x0f) {
2250 goto widep_in;
2251 }
2252 if (j == 0x0a) {
2253 goto widep_cmd;
2254 }
2255 if (j == 0x0e) {
2256 goto try_wide;
2257 }
2258 continue;
2259 widep_out:
2260 tmport = wkport + 0x58;
2261 outb(0x20, tmport);
2262 tmport += 0x07;
2263 while ((inb(tmport) & 0x80) == 0) {
2264 if ((inb(tmport) & 0x01) != 0) {
2265 tmport -= 0x06;
2266 outb(0, tmport);
2267 tmport += 0x06;
2268 }
2269 }
2270 tmport -= 0x08;
2271 j = inb(tmport) & 0x0f;
2272 if (j == 0x0f) {
2273 goto widep_in;
2274 }
2275 if (j == 0x0a) {
2276 goto widep_cmd;
2277 }
2278 if (j == 0x0e) {
2279 goto widep_out;
2280 }
2281 continue;
2282 widep_in:
2283 tmport = wkport + 0x54;
2284 outb(0xff, tmport);
2285 tmport += 0x04;
2286 outb(0x20, tmport);
2287 tmport += 0x07;
2288 k = 0;
2289 widep_in1:
2290 j = inb(tmport);
2291 if ((j & 0x01) != 0) {
2292 tmport -= 0x06;
2293 mbuf[k++] = inb(tmport);
2294 tmport += 0x06;
2295 goto widep_in1;
2296 }
2297 if ((j & 0x80) == 0x00) {
2298 goto widep_in1;
2299 }
2300 tmport -= 0x08;
2301 j = inb(tmport) & 0x0f;
2302 if (j == 0x0f) {
2303 goto widep_in;
2304 }
2305 if (j == 0x0a) {
2306 goto widep_cmd;
2307 }
2308 if (j == 0x0e) {
2309 goto widep_out;
2310 }
2311 continue;
2312 widep_cmd:
2313 tmport = wkport + 0x50;
2314 outb(0x30, tmport);
2315 tmport = wkport + 0x54;
2316 outb(0x00, tmport);
2317 tmport += 0x04;
2318 outb(0x08, tmport);
2319 tmport += 0x07;
2320
2321 while ((inb(tmport) & 0x80) == 0x00)
2322 cpu_relax();
2323
2324 tmport -= 0x08;
2325 j = inb(tmport);
2326 if (j != 0x16) {
2327 if (j == 0x4e) {
2328 goto widep_out;
2329 }
2330 continue;
2331 }
2332 if (mbuf[0] != 0x01) {
2333 goto not_wide;
2334 }
2335 if (mbuf[1] != 0x02) {
2336 goto not_wide;
2337 }
2338 if (mbuf[2] != 0x03) {
2339 goto not_wide;
2340 }
2341 if (mbuf[3] != 0x01) {
2342 goto not_wide;
2343 }
2344 m = 1;
2345 m = m << i;
2346 dev->wide_id[0] |= m;
2347 not_wide:
2348 if ((dev->id[0][i].devtype == 0x00) || (dev->id[0][i].devtype == 0x07) || ((dev->id[0][i].devtype == 0x05) && ((n & 0x10) != 0))) {
2349 m = 1;
2350 m = m << i;
2351 if ((dev->async[0] & m) != 0) {
2352 goto set_sync;
2353 }
2354 }
2355 continue;
2356 set_sync:
2357 if (dev->sp[0][i] == 0x02) {
2358 synu[4] = 0x0c;
2359 synuw[4] = 0x0c;
2360 } else {
2361 if (dev->sp[0][i] >= 0x03) {
2362 synu[4] = 0x0a;
2363 synuw[4] = 0x0a;
2364 }
2365 }
2366 tmport = wkport + 0x5b;
2367 j = 0;
2368 if ((m & dev->wide_id[0]) != 0) {
2369 j |= 0x01;
2370 }
2371 outb(j, tmport);
2372 tmport = wkport + 0x43;
2373 outb(satn[0], tmport++);
2374 outb(satn[1], tmport++);
2375 outb(satn[2], tmport++);
2376 outb(satn[3], tmport++);
2377 outb(satn[4], tmport++);
2378 outb(satn[5], tmport++);
2379 tmport += 0x06;
2380 outb(0, tmport);
2381 tmport += 0x02;
2382 outb(dev->id[0][i].devsp, tmport++);
2383 outb(0, tmport++);
2384 outb(satn[6], tmport++);
2385 outb(satn[7], tmport++);
2386 tmport += 0x03;
2387 outb(satn[8], tmport);
2388 tmport += 0x07;
2389
2390 while ((inb(tmport) & 0x80) == 0x00)
2391 cpu_relax();
2392
2393 tmport -= 0x08;
2394 if ((inb(tmport) != 0x11) && (inb(tmport) != 0x8e)) {
2395 continue;
2396 }
2397 while (inb(tmport) != 0x8e)
2398 cpu_relax();
2399
2400 try_sync:
2401 j = 0;
2402 tmport = wkport + 0x54;
2403 outb(0x06, tmport);
2404 tmport += 0x04;
2405 outb(0x20, tmport);
2406 tmport += 0x07;
2407
2408 while ((inb(tmport) & 0x80) == 0) {
2409 if ((inb(tmport) & 0x01) != 0) {
2410 tmport -= 0x06;
2411 if ((m & dev->wide_id[0]) != 0) {
2412 if ((m & dev->ultra_map[0]) != 0) {
2413 outb(synuw[j++], tmport);
2414 } else {
2415 outb(synw[j++], tmport);
2416 }
2417 } else {
2418 if ((m & dev->ultra_map[0]) != 0) {
2419 outb(synu[j++], tmport);
2420 } else {
2421 outb(synn[j++], tmport);
2422 }
2423 }
2424 tmport += 0x06;
2425 }
2426 }
2427 tmport -= 0x08;
2428
2429 while ((inb(tmport) & 0x80) == 0x00)
2430 cpu_relax();
2431
2432 j = inb(tmport) & 0x0f;
2433 if (j == 0x0f) {
2434 goto phase_ins;
2435 }
2436 if (j == 0x0a) {
2437 goto phase_cmds;
2438 }
2439 if (j == 0x0e) {
2440 goto try_sync;
2441 }
2442 continue;
2443 phase_outs:
2444 tmport = wkport + 0x58;
2445 outb(0x20, tmport);
2446 tmport += 0x07;
2447 while ((inb(tmport) & 0x80) == 0x00) {
2448 if ((inb(tmport) & 0x01) != 0x00) {
2449 tmport -= 0x06;
2450 outb(0x00, tmport);
2451 tmport += 0x06;
2452 }
2453 }
2454 tmport -= 0x08;
2455 j = inb(tmport);
2456 if (j == 0x85) {
2457 goto tar_dcons;
2458 }
2459 j &= 0x0f;
2460 if (j == 0x0f) {
2461 goto phase_ins;
2462 }
2463 if (j == 0x0a) {
2464 goto phase_cmds;
2465 }
2466 if (j == 0x0e) {
2467 goto phase_outs;
2468 }
2469 continue;
2470 phase_ins:
2471 tmport = wkport + 0x54;
2472 outb(0x06, tmport);
2473 tmport += 0x04;
2474 outb(0x20, tmport);
2475 tmport += 0x07;
2476 k = 0;
2477 phase_ins1:
2478 j = inb(tmport);
2479 if ((j & 0x01) != 0x00) {
2480 tmport -= 0x06;
2481 mbuf[k++] = inb(tmport);
2482 tmport += 0x06;
2483 goto phase_ins1;
2484 }
2485 if ((j & 0x80) == 0x00) {
2486 goto phase_ins1;
2487 }
2488 tmport -= 0x08;
2489
2490 while ((inb(tmport) & 0x80) == 0x00)
2491 cpu_relax();
2492
2493 j = inb(tmport);
2494 if (j == 0x85) {
2495 goto tar_dcons;
2496 }
2497 j &= 0x0f;
2498 if (j == 0x0f) {
2499 goto phase_ins;
2500 }
2501 if (j == 0x0a) {
2502 goto phase_cmds;
2503 }
2504 if (j == 0x0e) {
2505 goto phase_outs;
2506 }
2507 continue;
2508 phase_cmds:
2509 tmport = wkport + 0x50;
2510 outb(0x30, tmport);
2511 tar_dcons:
2512 tmport = wkport + 0x54;
2513 outb(0x00, tmport);
2514 tmport += 0x04;
2515 outb(0x08, tmport);
2516 tmport += 0x07;
2517
2518 while ((inb(tmport) & 0x80) == 0x00)
2519 cpu_relax();
2520
2521 tmport -= 0x08;
2522 j = inb(tmport);
2523 if (j != 0x16) {
2524 continue;
2525 }
2526 if (mbuf[0] != 0x01) {
2527 continue;
2528 }
2529 if (mbuf[1] != 0x03) {
2530 continue;
2531 }
2532 if (mbuf[4] == 0x00) {
2533 continue;
2534 }
2535 if (mbuf[3] > 0x64) {
2536 continue;
2537 }
2538 if (mbuf[4] > 0x0e) {
2539 mbuf[4] = 0x0e;
2540 }
2541 dev->id[0][i].devsp = mbuf[4];
2542 if (mbuf[3] < 0x0c) {
2543 j = 0xb0;
2544 goto set_syn_ok;
2545 }
2546 if ((mbuf[3] < 0x0d) && (rmb == 0)) {
2547 j = 0xa0;
2548 goto set_syn_ok;
2549 }
2550 if (mbuf[3] < 0x1a) {
2551 j = 0x20;
2552 goto set_syn_ok;
2553 }
2554 if (mbuf[3] < 0x33) {
2555 j = 0x40;
2556 goto set_syn_ok;
2557 }
2558 if (mbuf[3] < 0x4c) {
2559 j = 0x50;
2560 goto set_syn_ok;
2561 }
2562 j = 0x60;
2563 set_syn_ok:
2564 dev->id[0][i].devsp = (dev->id[0][i].devsp & 0x0f) | j;
2565 }
2566 }
2567
2568 static void atp870u_free_tables(struct Scsi_Host *host)
2569 {
2570 struct atp_unit *atp_dev = (struct atp_unit *)&host->hostdata;
2571 int j, k;
2572 for (j=0; j < 2; j++) {
2573 for (k = 0; k < 16; k++) {
2574 if (!atp_dev->id[j][k].prd_table)
2575 continue;
2576 pci_free_consistent(atp_dev->pdev, 1024, atp_dev->id[j][k].prd_table, atp_dev->id[j][k].prd_bus);
2577 atp_dev->id[j][k].prd_table = NULL;
2578 }
2579 }
2580 }
2581
2582 static int atp870u_init_tables(struct Scsi_Host *host)
2583 {
2584 struct atp_unit *atp_dev = (struct atp_unit *)&host->hostdata;
2585 int c,k;
2586 for(c=0;c < 2;c++) {
2587 for(k=0;k<16;k++) {
2588 atp_dev->id[c][k].prd_table = pci_alloc_consistent(atp_dev->pdev, 1024, &(atp_dev->id[c][k].prd_bus));
2589 if (!atp_dev->id[c][k].prd_table) {
2590 printk("atp870u_init_tables fail\n");
2591 atp870u_free_tables(host);
2592 return -ENOMEM;
2593 }
2594 atp_dev->id[c][k].prdaddr = atp_dev->id[c][k].prd_bus;
2595 atp_dev->id[c][k].devsp=0x20;
2596 atp_dev->id[c][k].devtype = 0x7f;
2597 atp_dev->id[c][k].curr_req = NULL;
2598 }
2599
2600 atp_dev->active_id[c] = 0;
2601 atp_dev->wide_id[c] = 0;
2602 atp_dev->host_id[c] = 0x07;
2603 atp_dev->quhd[c] = 0;
2604 atp_dev->quend[c] = 0;
2605 atp_dev->last_cmd[c] = 0xff;
2606 atp_dev->in_snd[c] = 0;
2607 atp_dev->in_int[c] = 0;
2608
2609 for (k = 0; k < qcnt; k++) {
2610 atp_dev->quereq[c][k] = NULL;
2611 }
2612 for (k = 0; k < 16; k++) {
2613 atp_dev->id[c][k].curr_req = NULL;
2614 atp_dev->sp[c][k] = 0x04;
2615 }
2616 }
2617 return 0;
2618 }
2619
2620 /* return non-zero on detection */
2621 static int atp870u_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
2622 {
2623 unsigned char k, m, c;
2624 unsigned long flags;
2625 unsigned int base_io, tmport, error,n;
2626 unsigned char host_id;
2627 struct Scsi_Host *shpnt = NULL;
2628 struct atp_unit *atpdev, *p;
2629 unsigned char setupdata[2][16];
2630 int count = 0;
2631
2632 atpdev = kzalloc(sizeof(*atpdev), GFP_KERNEL);
2633 if (!atpdev)
2634 return -ENOMEM;
2635
2636 if (pci_enable_device(pdev))
2637 goto err_eio;
2638
2639 if (!pci_set_dma_mask(pdev, DMA_32BIT_MASK)) {
2640 printk(KERN_INFO "atp870u: use 32bit DMA mask.\n");
2641 } else {
2642 printk(KERN_ERR "atp870u: DMA mask required but not available.\n");
2643 goto err_eio;
2644 }
2645
2646 /*
2647 * It's probably easier to weed out some revisions like
2648 * this than via the PCI device table
2649 */
2650 if (ent->device == PCI_DEVICE_ID_ARTOP_AEC7610) {
2651 error = pci_read_config_byte(pdev, PCI_CLASS_REVISION, &atpdev->chip_ver);
2652 if (atpdev->chip_ver < 2)
2653 goto err_eio;
2654 }
2655
2656 switch (ent->device) {
2657 case PCI_DEVICE_ID_ARTOP_AEC7612UW:
2658 case PCI_DEVICE_ID_ARTOP_AEC7612SUW:
2659 case ATP880_DEVID1:
2660 case ATP880_DEVID2:
2661 case ATP885_DEVID:
2662 atpdev->chip_ver = 0x04;
2663 default:
2664 break;
2665 }
2666 base_io = pci_resource_start(pdev, 0);
2667 base_io &= 0xfffffff8;
2668
2669 if ((ent->device == ATP880_DEVID1)||(ent->device == ATP880_DEVID2)) {
2670 error = pci_read_config_byte(pdev, PCI_CLASS_REVISION, &atpdev->chip_ver);
2671 pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0x80);//JCC082803
2672
2673 host_id = inb(base_io + 0x39);
2674 host_id >>= 0x04;
2675
2676 printk(KERN_INFO " ACARD AEC-67160 PCI Ultra3 LVD Host Adapter: %d"
2677 " IO:%x, IRQ:%d.\n", count, base_io, pdev->irq);
2678 atpdev->ioport[0] = base_io + 0x40;
2679 atpdev->pciport[0] = base_io + 0x28;
2680 atpdev->dev_id = ent->device;
2681 atpdev->host_id[0] = host_id;
2682
2683 tmport = base_io + 0x22;
2684 atpdev->scam_on = inb(tmport);
2685 tmport += 0x13;
2686 atpdev->global_map[0] = inb(tmport);
2687 tmport += 0x07;
2688 atpdev->ultra_map[0] = inw(tmport);
2689
2690 n = 0x3f09;
2691 next_fblk_880:
2692 if (n >= 0x4000)
2693 goto flash_ok_880;
2694
2695 m = 0;
2696 outw(n, base_io + 0x34);
2697 n += 0x0002;
2698 if (inb(base_io + 0x30) == 0xff)
2699 goto flash_ok_880;
2700
2701 atpdev->sp[0][m++] = inb(base_io + 0x30);
2702 atpdev->sp[0][m++] = inb(base_io + 0x31);
2703 atpdev->sp[0][m++] = inb(base_io + 0x32);
2704 atpdev->sp[0][m++] = inb(base_io + 0x33);
2705 outw(n, base_io + 0x34);
2706 n += 0x0002;
2707 atpdev->sp[0][m++] = inb(base_io + 0x30);
2708 atpdev->sp[0][m++] = inb(base_io + 0x31);
2709 atpdev->sp[0][m++] = inb(base_io + 0x32);
2710 atpdev->sp[0][m++] = inb(base_io + 0x33);
2711 outw(n, base_io + 0x34);
2712 n += 0x0002;
2713 atpdev->sp[0][m++] = inb(base_io + 0x30);
2714 atpdev->sp[0][m++] = inb(base_io + 0x31);
2715 atpdev->sp[0][m++] = inb(base_io + 0x32);
2716 atpdev->sp[0][m++] = inb(base_io + 0x33);
2717 outw(n, base_io + 0x34);
2718 n += 0x0002;
2719 atpdev->sp[0][m++] = inb(base_io + 0x30);
2720 atpdev->sp[0][m++] = inb(base_io + 0x31);
2721 atpdev->sp[0][m++] = inb(base_io + 0x32);
2722 atpdev->sp[0][m++] = inb(base_io + 0x33);
2723 n += 0x0018;
2724 goto next_fblk_880;
2725 flash_ok_880:
2726 outw(0, base_io + 0x34);
2727 atpdev->ultra_map[0] = 0;
2728 atpdev->async[0] = 0;
2729 for (k = 0; k < 16; k++) {
2730 n = 1;
2731 n = n << k;
2732 if (atpdev->sp[0][k] > 1) {
2733 atpdev->ultra_map[0] |= n;
2734 } else {
2735 if (atpdev->sp[0][k] == 0)
2736 atpdev->async[0] |= n;
2737 }
2738 }
2739 atpdev->async[0] = ~(atpdev->async[0]);
2740 outb(atpdev->global_map[0], base_io + 0x35);
2741
2742 shpnt = scsi_host_alloc(&atp870u_template, sizeof(struct atp_unit));
2743 if (!shpnt)
2744 goto err_nomem;
2745
2746 p = (struct atp_unit *)&shpnt->hostdata;
2747
2748 atpdev->host = shpnt;
2749 atpdev->pdev = pdev;
2750 pci_set_drvdata(pdev, p);
2751 memcpy(p, atpdev, sizeof(*atpdev));
2752 if (atp870u_init_tables(shpnt) < 0) {
2753 printk(KERN_ERR "Unable to allocate tables for Acard controller\n");
2754 goto unregister;
2755 }
2756
2757 if (request_irq(pdev->irq, atp870u_intr_handle, IRQF_SHARED, "atp880i", shpnt)) {
2758 printk(KERN_ERR "Unable to allocate IRQ%d for Acard controller.\n", pdev->irq);
2759 goto free_tables;
2760 }
2761
2762 spin_lock_irqsave(shpnt->host_lock, flags);
2763 tmport = base_io + 0x38;
2764 k = inb(tmport) & 0x80;
2765 outb(k, tmport);
2766 tmport += 0x03;
2767 outb(0x20, tmport);
2768 mdelay(32);
2769 outb(0, tmport);
2770 mdelay(32);
2771 tmport = base_io + 0x5b;
2772 inb(tmport);
2773 tmport -= 0x04;
2774 inb(tmport);
2775 tmport = base_io + 0x40;
2776 outb((host_id | 0x08), tmport);
2777 tmport += 0x18;
2778 outb(0, tmport);
2779 tmport += 0x07;
2780 while ((inb(tmport) & 0x80) == 0)
2781 mdelay(1);
2782 tmport -= 0x08;
2783 inb(tmport);
2784 tmport = base_io + 0x41;
2785 outb(8, tmport++);
2786 outb(0x7f, tmport);
2787 tmport = base_io + 0x51;
2788 outb(0x20, tmport);
2789
2790 tscam(shpnt);
2791 is880(p, base_io);
2792 tmport = base_io + 0x38;
2793 outb(0xb0, tmport);
2794 shpnt->max_id = 16;
2795 shpnt->this_id = host_id;
2796 shpnt->unique_id = base_io;
2797 shpnt->io_port = base_io;
2798 shpnt->n_io_port = 0x60; /* Number of bytes of I/O space used */
2799 shpnt->irq = pdev->irq;
2800 } else if (ent->device == ATP885_DEVID) {
2801 printk(KERN_INFO " ACARD AEC-67162 PCI Ultra3 LVD Host Adapter: IO:%x, IRQ:%d.\n"
2802 , base_io, pdev->irq);
2803
2804 atpdev->pdev = pdev;
2805 atpdev->dev_id = ent->device;
2806 atpdev->baseport = base_io;
2807 atpdev->ioport[0] = base_io + 0x80;
2808 atpdev->ioport[1] = base_io + 0xc0;
2809 atpdev->pciport[0] = base_io + 0x40;
2810 atpdev->pciport[1] = base_io + 0x50;
2811
2812 shpnt = scsi_host_alloc(&atp870u_template, sizeof(struct atp_unit));
2813 if (!shpnt)
2814 goto err_nomem;
2815
2816 p = (struct atp_unit *)&shpnt->hostdata;
2817
2818 atpdev->host = shpnt;
2819 atpdev->pdev = pdev;
2820 pci_set_drvdata(pdev, p);
2821 memcpy(p, atpdev, sizeof(struct atp_unit));
2822 if (atp870u_init_tables(shpnt) < 0)
2823 goto unregister;
2824
2825 #ifdef ED_DBGP
2826 printk("request_irq() shpnt %p hostdata %p\n", shpnt, p);
2827 #endif
2828 if (request_irq(pdev->irq, atp870u_intr_handle, IRQF_SHARED, "atp870u", shpnt)) {
2829 printk(KERN_ERR "Unable to allocate IRQ for Acard controller.\n");
2830 goto free_tables;
2831 }
2832
2833 spin_lock_irqsave(shpnt->host_lock, flags);
2834
2835 c=inb(base_io + 0x29);
2836 outb((c | 0x04),base_io + 0x29);
2837
2838 n=0x1f80;
2839 next_fblk_885:
2840 if (n >= 0x2000) {
2841 goto flash_ok_885;
2842 }
2843 outw(n,base_io + 0x3c);
2844 if (inl(base_io + 0x38) == 0xffffffff) {
2845 goto flash_ok_885;
2846 }
2847 for (m=0; m < 2; m++) {
2848 p->global_map[m]= 0;
2849 for (k=0; k < 4; k++) {
2850 outw(n++,base_io + 0x3c);
2851 ((unsigned long *)&setupdata[m][0])[k]=inl(base_io + 0x38);
2852 }
2853 for (k=0; k < 4; k++) {
2854 outw(n++,base_io + 0x3c);
2855 ((unsigned long *)&p->sp[m][0])[k]=inl(base_io + 0x38);
2856 }
2857 n += 8;
2858 }
2859 goto next_fblk_885;
2860 flash_ok_885:
2861 #ifdef ED_DBGP
2862 printk( "Flash Read OK\n");
2863 #endif
2864 c=inb(base_io + 0x29);
2865 outb((c & 0xfb),base_io + 0x29);
2866 for (c=0;c < 2;c++) {
2867 p->ultra_map[c]=0;
2868 p->async[c] = 0;
2869 for (k=0; k < 16; k++) {
2870 n=1;
2871 n = n << k;
2872 if (p->sp[c][k] > 1) {
2873 p->ultra_map[c] |= n;
2874 } else {
2875 if (p->sp[c][k] == 0) {
2876 p->async[c] |= n;
2877 }
2878 }
2879 }
2880 p->async[c] = ~(p->async[c]);
2881
2882 if (p->global_map[c] == 0) {
2883 k=setupdata[c][1];
2884 if ((k & 0x40) != 0)
2885 p->global_map[c] |= 0x20;
2886 k &= 0x07;
2887 p->global_map[c] |= k;
2888 if ((setupdata[c][2] & 0x04) != 0)
2889 p->global_map[c] |= 0x08;
2890 p->host_id[c] = setupdata[c][0] & 0x07;
2891 }
2892 }
2893
2894 k = inb(base_io + 0x28) & 0x8f;
2895 k |= 0x10;
2896 outb(k, base_io + 0x28);
2897 outb(0x80, base_io + 0x41);
2898 outb(0x80, base_io + 0x51);
2899 mdelay(100);
2900 outb(0, base_io + 0x41);
2901 outb(0, base_io + 0x51);
2902 mdelay(1000);
2903 inb(base_io + 0x9b);
2904 inb(base_io + 0x97);
2905 inb(base_io + 0xdb);
2906 inb(base_io + 0xd7);
2907 tmport = base_io + 0x80;
2908 k=p->host_id[0];
2909 if (k > 7)
2910 k = (k & 0x07) | 0x40;
2911 k |= 0x08;
2912 outb(k, tmport);
2913 tmport += 0x18;
2914 outb(0, tmport);
2915 tmport += 0x07;
2916
2917 while ((inb(tmport) & 0x80) == 0)
2918 cpu_relax();
2919
2920 tmport -= 0x08;
2921 inb(tmport);
2922 tmport = base_io + 0x81;
2923 outb(8, tmport++);
2924 outb(0x7f, tmport);
2925 tmport = base_io + 0x91;
2926 outb(0x20, tmport);
2927
2928 tmport = base_io + 0xc0;
2929 k=p->host_id[1];
2930 if (k > 7)
2931 k = (k & 0x07) | 0x40;
2932 k |= 0x08;
2933 outb(k, tmport);
2934 tmport += 0x18;
2935 outb(0, tmport);
2936 tmport += 0x07;
2937
2938 while ((inb(tmport) & 0x80) == 0)
2939 cpu_relax();
2940
2941 tmport -= 0x08;
2942 inb(tmport);
2943 tmport = base_io + 0xc1;
2944 outb(8, tmport++);
2945 outb(0x7f, tmport);
2946 tmport = base_io + 0xd1;
2947 outb(0x20, tmport);
2948
2949 tscam_885();
2950 printk(KERN_INFO " Scanning Channel A SCSI Device ...\n");
2951 is885(p, base_io + 0x80, 0);
2952 printk(KERN_INFO " Scanning Channel B SCSI Device ...\n");
2953 is885(p, base_io + 0xc0, 1);
2954
2955 k = inb(base_io + 0x28) & 0xcf;
2956 k |= 0xc0;
2957 outb(k, base_io + 0x28);
2958 k = inb(base_io + 0x1f) | 0x80;
2959 outb(k, base_io + 0x1f);
2960 k = inb(base_io + 0x29) | 0x01;
2961 outb(k, base_io + 0x29);
2962 #ifdef ED_DBGP
2963 //printk("atp885: atp_host[0] 0x%p\n", atp_host[0]);
2964 #endif
2965 shpnt->max_id = 16;
2966 shpnt->max_lun = (p->global_map[0] & 0x07) + 1;
2967 shpnt->max_channel = 1;
2968 shpnt->this_id = p->host_id[0];
2969 shpnt->unique_id = base_io;
2970 shpnt->io_port = base_io;
2971 shpnt->n_io_port = 0xff; /* Number of bytes of I/O space used */
2972 shpnt->irq = pdev->irq;
2973
2974 } else {
2975 error = pci_read_config_byte(pdev, 0x49, &host_id);
2976
2977 printk(KERN_INFO " ACARD AEC-671X PCI Ultra/W SCSI-2/3 Host Adapter: %d "
2978 "IO:%x, IRQ:%d.\n", count, base_io, pdev->irq);
2979
2980 atpdev->ioport[0] = base_io;
2981 atpdev->pciport[0] = base_io + 0x20;
2982 atpdev->dev_id = ent->device;
2983 host_id &= 0x07;
2984 atpdev->host_id[0] = host_id;
2985 tmport = base_io + 0x22;
2986 atpdev->scam_on = inb(tmport);
2987 tmport += 0x0b;
2988 atpdev->global_map[0] = inb(tmport++);
2989 atpdev->ultra_map[0] = inw(tmport);
2990
2991 if (atpdev->ultra_map[0] == 0) {
2992 atpdev->scam_on = 0x00;
2993 atpdev->global_map[0] = 0x20;
2994 atpdev->ultra_map[0] = 0xffff;
2995 }
2996
2997 shpnt = scsi_host_alloc(&atp870u_template, sizeof(struct atp_unit));
2998 if (!shpnt)
2999 goto err_nomem;
3000
3001 p = (struct atp_unit *)&shpnt->hostdata;
3002
3003 atpdev->host = shpnt;
3004 atpdev->pdev = pdev;
3005 pci_set_drvdata(pdev, p);
3006 memcpy(p, atpdev, sizeof(*atpdev));
3007 if (atp870u_init_tables(shpnt) < 0)
3008 goto unregister;
3009
3010 if (request_irq(pdev->irq, atp870u_intr_handle, IRQF_SHARED, "atp870i", shpnt)) {
3011 printk(KERN_ERR "Unable to allocate IRQ%d for Acard controller.\n", pdev->irq);
3012 goto free_tables;
3013 }
3014
3015 spin_lock_irqsave(shpnt->host_lock, flags);
3016 if (atpdev->chip_ver > 0x07) { /* check if atp876 chip then enable terminator */
3017 tmport = base_io + 0x3e;
3018 outb(0x00, tmport);
3019 }
3020
3021 tmport = base_io + 0x3a;
3022 k = (inb(tmport) & 0xf3) | 0x10;
3023 outb(k, tmport);
3024 outb((k & 0xdf), tmport);
3025 mdelay(32);
3026 outb(k, tmport);
3027 mdelay(32);
3028 tmport = base_io;
3029 outb((host_id | 0x08), tmport);
3030 tmport += 0x18;
3031 outb(0, tmport);
3032 tmport += 0x07;
3033 while ((inb(tmport) & 0x80) == 0)
3034 mdelay(1);
3035
3036 tmport -= 0x08;
3037 inb(tmport);
3038 tmport = base_io + 1;
3039 outb(8, tmport++);
3040 outb(0x7f, tmport);
3041 tmport = base_io + 0x11;
3042 outb(0x20, tmport);
3043
3044 tscam(shpnt);
3045 is870(p, base_io);
3046 tmport = base_io + 0x3a;
3047 outb((inb(tmport) & 0xef), tmport);
3048 tmport++;
3049 outb((inb(tmport) | 0x20), tmport);
3050 if (atpdev->chip_ver == 4)
3051 shpnt->max_id = 16;
3052 else
3053 shpnt->max_id = 8;
3054 shpnt->this_id = host_id;
3055 shpnt->unique_id = base_io;
3056 shpnt->io_port = base_io;
3057 shpnt->n_io_port = 0x40; /* Number of bytes of I/O space used */
3058 shpnt->irq = pdev->irq;
3059 }
3060 spin_unlock_irqrestore(shpnt->host_lock, flags);
3061 if(ent->device==ATP885_DEVID) {
3062 if(!request_region(base_io, 0xff, "atp870u")) /* Register the IO ports that we use */
3063 goto request_io_fail;
3064 } else if((ent->device==ATP880_DEVID1)||(ent->device==ATP880_DEVID2)) {
3065 if(!request_region(base_io, 0x60, "atp870u")) /* Register the IO ports that we use */
3066 goto request_io_fail;
3067 } else {
3068 if(!request_region(base_io, 0x40, "atp870u")) /* Register the IO ports that we use */
3069 goto request_io_fail;
3070 }
3071 count++;
3072 if (scsi_add_host(shpnt, &pdev->dev))
3073 goto scsi_add_fail;
3074 scsi_scan_host(shpnt);
3075 #ifdef ED_DBGP
3076 printk("atp870u_prob : exit\n");
3077 #endif
3078 return 0;
3079
3080 scsi_add_fail:
3081 printk("atp870u_prob:scsi_add_fail\n");
3082 if(ent->device==ATP885_DEVID) {
3083 release_region(base_io, 0xff);
3084 } else if((ent->device==ATP880_DEVID1)||(ent->device==ATP880_DEVID2)) {
3085 release_region(base_io, 0x60);
3086 } else {
3087 release_region(base_io, 0x40);
3088 }
3089 request_io_fail:
3090 printk("atp870u_prob:request_io_fail\n");
3091 free_irq(pdev->irq, shpnt);
3092 free_tables:
3093 printk("atp870u_prob:free_table\n");
3094 atp870u_free_tables(shpnt);
3095 unregister:
3096 printk("atp870u_prob:unregister\n");
3097 scsi_host_put(shpnt);
3098 return -1;
3099 err_eio:
3100 kfree(atpdev);
3101 return -EIO;
3102 err_nomem:
3103 kfree(atpdev);
3104 return -ENOMEM;
3105 }
3106
3107 /* The abort command does not leave the device in a clean state where
3108 it is available to be used again. Until this gets worked out, we will
3109 leave it commented out. */
3110
3111 static int atp870u_abort(struct scsi_cmnd * SCpnt)
3112 {
3113 unsigned char j, k, c;
3114 struct scsi_cmnd *workrequ;
3115 unsigned int tmport;
3116 struct atp_unit *dev;
3117 struct Scsi_Host *host;
3118 host = SCpnt->device->host;
3119
3120 dev = (struct atp_unit *)&host->hostdata;
3121 c = scmd_channel(SCpnt);
3122 printk(" atp870u: abort Channel = %x \n", c);
3123 printk("working=%x last_cmd=%x ", dev->working[c], dev->last_cmd[c]);
3124 printk(" quhdu=%x quendu=%x ", dev->quhd[c], dev->quend[c]);
3125 tmport = dev->ioport[c];
3126 for (j = 0; j < 0x18; j++) {
3127 printk(" r%2x=%2x", j, inb(tmport++));
3128 }
3129 tmport += 0x04;
3130 printk(" r1c=%2x", inb(tmport));
3131 tmport += 0x03;
3132 printk(" r1f=%2x in_snd=%2x ", inb(tmport), dev->in_snd[c]);
3133 tmport= dev->pciport[c];
3134 printk(" d00=%2x", inb(tmport));
3135 tmport += 0x02;
3136 printk(" d02=%2x", inb(tmport));
3137 for(j=0;j<16;j++) {
3138 if (dev->id[c][j].curr_req != NULL) {
3139 workrequ = dev->id[c][j].curr_req;
3140 printk("\n que cdb= ");
3141 for (k=0; k < workrequ->cmd_len; k++) {
3142 printk(" %2x ",workrequ->cmnd[k]);
3143 }
3144 printk(" last_lenu= %x ",(unsigned int)dev->id[c][j].last_len);
3145 }
3146 }
3147 return SUCCESS;
3148 }
3149
3150 static const char *atp870u_info(struct Scsi_Host *notused)
3151 {
3152 static char buffer[128];
3153
3154 strcpy(buffer, "ACARD AEC-6710/6712/67160 PCI Ultra/W/LVD SCSI-3 Adapter Driver V2.6+ac ");
3155
3156 return buffer;
3157 }
3158
3159 #define BLS buffer + len + size
3160 static int atp870u_proc_info(struct Scsi_Host *HBAptr, char *buffer,
3161 char **start, off_t offset, int length, int inout)
3162 {
3163 static u8 buff[512];
3164 int size = 0;
3165 int len = 0;
3166 off_t begin = 0;
3167 off_t pos = 0;
3168
3169 if (inout)
3170 return -EINVAL;
3171 if (offset == 0)
3172 memset(buff, 0, sizeof(buff));
3173 size += sprintf(BLS, "ACARD AEC-671X Driver Version: 2.6+ac\n");
3174 len += size;
3175 pos = begin + len;
3176 size = 0;
3177
3178 size += sprintf(BLS, "\n");
3179 size += sprintf(BLS, "Adapter Configuration:\n");
3180 size += sprintf(BLS, " Base IO: %#.4lx\n", HBAptr->io_port);
3181 size += sprintf(BLS, " IRQ: %d\n", HBAptr->irq);
3182 len += size;
3183 pos = begin + len;
3184
3185 *start = buffer + (offset - begin); /* Start of wanted data */
3186 len -= (offset - begin); /* Start slop */
3187 if (len > length) {
3188 len = length; /* Ending slop */
3189 }
3190 return (len);
3191 }
3192
3193
3194 static int atp870u_biosparam(struct scsi_device *disk, struct block_device *dev,
3195 sector_t capacity, int *ip)
3196 {
3197 int heads, sectors, cylinders;
3198
3199 heads = 64;
3200 sectors = 32;
3201 cylinders = (unsigned long)capacity / (heads * sectors);
3202 if (cylinders > 1024) {
3203 heads = 255;
3204 sectors = 63;
3205 cylinders = (unsigned long)capacity / (heads * sectors);
3206 }
3207 ip[0] = heads;
3208 ip[1] = sectors;
3209 ip[2] = cylinders;
3210
3211 return 0;
3212 }
3213
3214 static void atp870u_remove (struct pci_dev *pdev)
3215 {
3216 struct atp_unit *devext = pci_get_drvdata(pdev);
3217 struct Scsi_Host *pshost = devext->host;
3218
3219
3220 scsi_remove_host(pshost);
3221 printk(KERN_INFO "free_irq : %d\n",pshost->irq);
3222 free_irq(pshost->irq, pshost);
3223 release_region(pshost->io_port, pshost->n_io_port);
3224 printk(KERN_INFO "atp870u_free_tables : %p\n",pshost);
3225 atp870u_free_tables(pshost);
3226 printk(KERN_INFO "scsi_host_put : %p\n",pshost);
3227 scsi_host_put(pshost);
3228 printk(KERN_INFO "pci_set_drvdata : %p\n",pdev);
3229 pci_set_drvdata(pdev, NULL);
3230 }
3231 MODULE_LICENSE("GPL");
3232
3233 static struct scsi_host_template atp870u_template = {
3234 .module = THIS_MODULE,
3235 .name = "atp870u" /* name */,
3236 .proc_name = "atp870u",
3237 .proc_info = atp870u_proc_info,
3238 .info = atp870u_info /* info */,
3239 .queuecommand = atp870u_queuecommand /* queuecommand */,
3240 .eh_abort_handler = atp870u_abort /* abort */,
3241 .bios_param = atp870u_biosparam /* biosparm */,
3242 .can_queue = qcnt /* can_queue */,
3243 .this_id = 7 /* SCSI ID */,
3244 .sg_tablesize = ATP870U_SCATTER /*SG_ALL*/ /*SG_NONE*/,
3245 .cmd_per_lun = ATP870U_CMDLUN /* commands per lun */,
3246 .use_clustering = ENABLE_CLUSTERING,
3247 .max_sectors = ATP870U_MAX_SECTORS,
3248 };
3249
3250 static struct pci_device_id atp870u_id_table[] = {
3251 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, ATP885_DEVID) },
3252 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, ATP880_DEVID1) },
3253 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, ATP880_DEVID2) },
3254 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7610) },
3255 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612UW) },
3256 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612U) },
3257 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612S) },
3258 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612D) },
3259 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612SUW) },
3260 { PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_8060) },
3261 { 0, },
3262 };
3263
3264 MODULE_DEVICE_TABLE(pci, atp870u_id_table);
3265
3266 static struct pci_driver atp870u_driver = {
3267 .id_table = atp870u_id_table,
3268 .name = "atp870u",
3269 .probe = atp870u_probe,
3270 .remove = __devexit_p(atp870u_remove),
3271 };
3272
3273 static int __init atp870u_init(void)
3274 {
3275 #ifdef ED_DBGP
3276 printk("atp870u_init: Entry\n");
3277 #endif
3278 return pci_register_driver(&atp870u_driver);
3279 }
3280
3281 static void __exit atp870u_exit(void)
3282 {
3283 #ifdef ED_DBGP
3284 printk("atp870u_exit: Entry\n");
3285 #endif
3286 pci_unregister_driver(&atp870u_driver);
3287 }
3288
3289 static void tscam_885(void)
3290 {
3291 unsigned char i;
3292
3293 for (i = 0; i < 0x2; i++) {
3294 mdelay(300);
3295 }
3296 return;
3297 }
3298
3299
3300
3301 static void is885(struct atp_unit *dev, unsigned int wkport,unsigned char c)
3302 {
3303 unsigned int tmport;
3304 unsigned char i, j, k, rmb, n, lvdmode;
3305 unsigned short int m;
3306 static unsigned char mbuf[512];
3307 static unsigned char satn[9] = {0, 0, 0, 0, 0, 0, 0, 6, 6};
3308 static unsigned char inqd[9] = {0x12, 0, 0, 0, 0x24, 0, 0, 0x24, 6};
3309 static unsigned char synn[6] = {0x80, 1, 3, 1, 0x19, 0x0e};
3310 unsigned char synu[6] = {0x80, 1, 3, 1, 0x0a, 0x0e};
3311 static unsigned char synw[6] = {0x80, 1, 3, 1, 0x19, 0x0e};
3312 unsigned char synuw[6] = {0x80, 1, 3, 1, 0x0a, 0x0e};
3313 static unsigned char wide[6] = {0x80, 1, 2, 3, 1, 0};
3314 static unsigned char u3[9] = { 0x80,1,6,4,0x09,00,0x0e,0x01,0x02 };
3315
3316 lvdmode=inb(wkport + 0x1b) >> 7;
3317
3318 for (i = 0; i < 16; i++) {
3319 m = 1;
3320 m = m << i;
3321 if ((m & dev->active_id[c]) != 0) {
3322 continue;
3323 }
3324 if (i == dev->host_id[c]) {
3325 printk(KERN_INFO " ID: %2d Host Adapter\n", dev->host_id[c]);
3326 continue;
3327 }
3328 tmport = wkport + 0x1b;
3329 outb(0x01, tmport);
3330 tmport = wkport + 0x01;
3331 outb(0x08, tmport++);
3332 outb(0x7f, tmport++);
3333 outb(satn[0], tmport++);
3334 outb(satn[1], tmport++);
3335 outb(satn[2], tmport++);
3336 outb(satn[3], tmport++);
3337 outb(satn[4], tmport++);
3338 outb(satn[5], tmport++);
3339 tmport += 0x06;
3340 outb(0, tmport);
3341 tmport += 0x02;
3342 outb(dev->id[c][i].devsp, tmport++);
3343
3344 outb(0, tmport++);
3345 outb(satn[6], tmport++);
3346 outb(satn[7], tmport++);
3347 j = i;
3348 if ((j & 0x08) != 0) {
3349 j = (j & 0x07) | 0x40;
3350 }
3351 outb(j, tmport);
3352 tmport += 0x03;
3353 outb(satn[8], tmport);
3354 tmport += 0x07;
3355
3356 while ((inb(tmport) & 0x80) == 0x00)
3357 cpu_relax();
3358 tmport -= 0x08;
3359 if ((inb(tmport) != 0x11) && (inb(tmport) != 0x8e)) {
3360 continue;
3361 }
3362 while (inb(tmport) != 0x8e)
3363 cpu_relax();
3364 dev->active_id[c] |= m;
3365
3366 tmport = wkport + 0x10;
3367 outb(0x30, tmport);
3368 tmport = wkport + 0x14;
3369 outb(0x00, tmport);
3370
3371 phase_cmd:
3372 tmport = wkport + 0x18;
3373 outb(0x08, tmport);
3374 tmport += 0x07;
3375 while ((inb(tmport) & 0x80) == 0x00)
3376 cpu_relax();
3377 tmport -= 0x08;
3378 j = inb(tmport);
3379 if (j != 0x16) {
3380 tmport = wkport + 0x10;
3381 outb(0x41, tmport);
3382 goto phase_cmd;
3383 }
3384 sel_ok:
3385 tmport = wkport + 0x03;
3386 outb(inqd[0], tmport++);
3387 outb(inqd[1], tmport++);
3388 outb(inqd[2], tmport++);
3389 outb(inqd[3], tmport++);
3390 outb(inqd[4], tmport++);
3391 outb(inqd[5], tmport);
3392 tmport += 0x07;
3393 outb(0, tmport);
3394 tmport += 0x02;
3395 outb(dev->id[c][i].devsp, tmport++);
3396 outb(0, tmport++);
3397 outb(inqd[6], tmport++);
3398 outb(inqd[7], tmport++);
3399 tmport += 0x03;
3400 outb(inqd[8], tmport);
3401 tmport += 0x07;
3402 while ((inb(tmport) & 0x80) == 0x00)
3403 cpu_relax();
3404 tmport -= 0x08;
3405 if ((inb(tmport) != 0x11) && (inb(tmport) != 0x8e)) {
3406 continue;
3407 }
3408 while (inb(tmport) != 0x8e)
3409 cpu_relax();
3410 tmport = wkport + 0x1b;
3411 outb(0x00, tmport);
3412 tmport = wkport + 0x18;
3413 outb(0x08, tmport);
3414 tmport += 0x07;
3415 j = 0;
3416 rd_inq_data:
3417 k = inb(tmport);
3418 if ((k & 0x01) != 0) {
3419 tmport -= 0x06;
3420 mbuf[j++] = inb(tmport);
3421 tmport += 0x06;
3422 goto rd_inq_data;
3423 }
3424 if ((k & 0x80) == 0) {
3425 goto rd_inq_data;
3426 }
3427 tmport -= 0x08;
3428 j = inb(tmport);
3429 if (j == 0x16) {
3430 goto inq_ok;
3431 }
3432 tmport = wkport + 0x10;
3433 outb(0x46, tmport);
3434 tmport += 0x02;
3435 outb(0, tmport++);
3436 outb(0, tmport++);
3437 outb(0, tmport++);
3438 tmport += 0x03;
3439 outb(0x08, tmport);
3440 tmport += 0x07;
3441 while ((inb(tmport) & 0x80) == 0x00)
3442 cpu_relax();
3443 tmport -= 0x08;
3444 if (inb(tmport) != 0x16) {
3445 goto sel_ok;
3446 }
3447 inq_ok:
3448 mbuf[36] = 0;
3449 printk( KERN_INFO" ID: %2d %s\n", i, &mbuf[8]);
3450 dev->id[c][i].devtype = mbuf[0];
3451 rmb = mbuf[1];
3452 n = mbuf[7];
3453 if ((mbuf[7] & 0x60) == 0) {
3454 goto not_wide;
3455 }
3456 if ((i < 8) && ((dev->global_map[c] & 0x20) == 0)) {
3457 goto not_wide;
3458 }
3459 if (lvdmode == 0) {
3460 goto chg_wide;
3461 }
3462 if (dev->sp[c][i] != 0x04) { // force u2
3463 goto chg_wide;
3464 }
3465
3466 tmport = wkport + 0x1b;
3467 outb(0x01, tmport);
3468 tmport = wkport + 0x03;
3469 outb(satn[0], tmport++);
3470 outb(satn[1], tmport++);
3471 outb(satn[2], tmport++);
3472 outb(satn[3], tmport++);
3473 outb(satn[4], tmport++);
3474 outb(satn[5], tmport++);
3475 tmport += 0x06;
3476 outb(0, tmport);
3477 tmport += 0x02;
3478 outb(dev->id[c][i].devsp, tmport++);
3479 outb(0, tmport++);
3480 outb(satn[6], tmport++);
3481 outb(satn[7], tmport++);
3482 tmport += 0x03;
3483 outb(satn[8], tmport);
3484 tmport += 0x07;
3485
3486 while ((inb(tmport) & 0x80) == 0x00)
3487 cpu_relax();
3488 tmport -= 0x08;
3489 if ((inb(tmport) != 0x11) && (inb(tmport) != 0x8e)) {
3490 continue;
3491 }
3492 while (inb(tmport) != 0x8e)
3493 cpu_relax();
3494 try_u3:
3495 j = 0;
3496 tmport = wkport + 0x14;
3497 outb(0x09, tmport);
3498 tmport += 0x04;
3499 outb(0x20, tmport);
3500 tmport += 0x07;
3501
3502 while ((inb(tmport) & 0x80) == 0) {
3503 if ((inb(tmport) & 0x01) != 0) {
3504 tmport -= 0x06;
3505 outb(u3[j++], tmport);
3506 tmport += 0x06;
3507 }
3508 cpu_relax();
3509 }
3510 tmport -= 0x08;
3511 while ((inb(tmport) & 0x80) == 0x00)
3512 cpu_relax();
3513 j = inb(tmport) & 0x0f;
3514 if (j == 0x0f) {
3515 goto u3p_in;
3516 }
3517 if (j == 0x0a) {
3518 goto u3p_cmd;
3519 }
3520 if (j == 0x0e) {
3521 goto try_u3;
3522 }
3523 continue;
3524 u3p_out:
3525 tmport = wkport + 0x18;
3526 outb(0x20, tmport);
3527 tmport += 0x07;
3528 while ((inb(tmport) & 0x80) == 0) {
3529 if ((inb(tmport) & 0x01) != 0) {
3530 tmport -= 0x06;
3531 outb(0, tmport);
3532 tmport += 0x06;
3533 }
3534 cpu_relax();
3535 }
3536 tmport -= 0x08;
3537 j = inb(tmport) & 0x0f;
3538 if (j == 0x0f) {
3539 goto u3p_in;
3540 }
3541 if (j == 0x0a) {
3542 goto u3p_cmd;
3543 }
3544 if (j == 0x0e) {
3545 goto u3p_out;
3546 }
3547 continue;
3548 u3p_in:
3549 tmport = wkport + 0x14;
3550 outb(0x09, tmport);
3551 tmport += 0x04;
3552 outb(0x20, tmport);
3553 tmport += 0x07;
3554 k = 0;
3555 u3p_in1:
3556 j = inb(tmport);
3557 if ((j & 0x01) != 0) {
3558 tmport -= 0x06;
3559 mbuf[k++] = inb(tmport);
3560 tmport += 0x06;
3561 goto u3p_in1;
3562 }
3563 if ((j & 0x80) == 0x00) {
3564 goto u3p_in1;
3565 }
3566 tmport -= 0x08;
3567 j = inb(tmport) & 0x0f;
3568 if (j == 0x0f) {
3569 goto u3p_in;
3570 }
3571 if (j == 0x0a) {
3572 goto u3p_cmd;
3573 }
3574 if (j == 0x0e) {
3575 goto u3p_out;
3576 }
3577 continue;
3578 u3p_cmd:
3579 tmport = wkport + 0x10;
3580 outb(0x30, tmport);
3581 tmport = wkport + 0x14;
3582 outb(0x00, tmport);
3583 tmport += 0x04;
3584 outb(0x08, tmport);
3585 tmport += 0x07;
3586 while ((inb(tmport) & 0x80) == 0x00);
3587 tmport -= 0x08;
3588 j = inb(tmport);
3589 if (j != 0x16) {
3590 if (j == 0x4e) {
3591 goto u3p_out;
3592 }
3593 continue;
3594 }
3595 if (mbuf[0] != 0x01) {
3596 goto chg_wide;
3597 }
3598 if (mbuf[1] != 0x06) {
3599 goto chg_wide;
3600 }
3601 if (mbuf[2] != 0x04) {
3602 goto chg_wide;
3603 }
3604 if (mbuf[3] == 0x09) {
3605 m = 1;
3606 m = m << i;
3607 dev->wide_id[c] |= m;
3608 dev->id[c][i].devsp = 0xce;
3609 #ifdef ED_DBGP
3610 printk("dev->id[%2d][%2d].devsp = %2x\n",c,i,dev->id[c][i].devsp);
3611 #endif
3612 continue;
3613 }
3614 chg_wide:
3615 tmport = wkport + 0x1b;
3616 outb(0x01, tmport);
3617 tmport = wkport + 0x03;
3618 outb(satn[0], tmport++);
3619 outb(satn[1], tmport++);
3620 outb(satn[2], tmport++);
3621 outb(satn[3], tmport++);
3622 outb(satn[4], tmport++);
3623 outb(satn[5], tmport++);
3624 tmport += 0x06;
3625 outb(0, tmport);
3626 tmport += 0x02;
3627 outb(dev->id[c][i].devsp, tmport++);
3628 outb(0, tmport++);
3629 outb(satn[6], tmport++);
3630 outb(satn[7], tmport++);
3631 tmport += 0x03;
3632 outb(satn[8], tmport);
3633 tmport += 0x07;
3634
3635 while ((inb(tmport) & 0x80) == 0x00)
3636 cpu_relax();
3637 tmport -= 0x08;
3638 if ((inb(tmport) != 0x11) && (inb(tmport) != 0x8e)) {
3639 continue;
3640 }
3641 while (inb(tmport) != 0x8e)
3642 cpu_relax();
3643 try_wide:
3644 j = 0;
3645 tmport = wkport + 0x14;
3646 outb(0x05, tmport);
3647 tmport += 0x04;
3648 outb(0x20, tmport);
3649 tmport += 0x07;
3650
3651 while ((inb(tmport) & 0x80) == 0) {
3652 if ((inb(tmport) & 0x01) != 0) {
3653 tmport -= 0x06;
3654 outb(wide[j++], tmport);
3655 tmport += 0x06;
3656 }
3657 cpu_relax();
3658 }
3659 tmport -= 0x08;
3660 while ((inb(tmport) & 0x80) == 0x00)
3661 cpu_relax();
3662 j = inb(tmport) & 0x0f;
3663 if (j == 0x0f) {
3664 goto widep_in;
3665 }
3666 if (j == 0x0a) {
3667 goto widep_cmd;
3668 }
3669 if (j == 0x0e) {
3670 goto try_wide;
3671 }
3672 continue;
3673 widep_out:
3674 tmport = wkport + 0x18;
3675 outb(0x20, tmport);
3676 tmport += 0x07;
3677 while ((inb(tmport) & 0x80) == 0) {
3678 if ((inb(tmport) & 0x01) != 0) {
3679 tmport -= 0x06;
3680 outb(0, tmport);
3681 tmport += 0x06;
3682 }
3683 cpu_relax();
3684 }
3685 tmport -= 0x08;
3686 j = inb(tmport) & 0x0f;
3687 if (j == 0x0f) {
3688 goto widep_in;
3689 }
3690 if (j == 0x0a) {
3691 goto widep_cmd;
3692 }
3693 if (j == 0x0e) {
3694 goto widep_out;
3695 }
3696 continue;
3697 widep_in:
3698 tmport = wkport + 0x14;
3699 outb(0xff, tmport);
3700 tmport += 0x04;
3701 outb(0x20, tmport);
3702 tmport += 0x07;
3703 k = 0;
3704 widep_in1:
3705 j = inb(tmport);
3706 if ((j & 0x01) != 0) {
3707 tmport -= 0x06;
3708 mbuf[k++] = inb(tmport);
3709 tmport += 0x06;
3710 goto widep_in1;
3711 }
3712 if ((j & 0x80) == 0x00) {
3713 goto widep_in1;
3714 }
3715 tmport -= 0x08;
3716 j = inb(tmport) & 0x0f;
3717 if (j == 0x0f) {
3718 goto widep_in;
3719 }
3720 if (j == 0x0a) {
3721 goto widep_cmd;
3722 }
3723 if (j == 0x0e) {
3724 goto widep_out;
3725 }
3726 continue;
3727 widep_cmd:
3728 tmport = wkport + 0x10;
3729 outb(0x30, tmport);
3730 tmport = wkport + 0x14;
3731 outb(0x00, tmport);
3732 tmport += 0x04;
3733 outb(0x08, tmport);
3734 tmport += 0x07;
3735 while ((inb(tmport) & 0x80) == 0x00)
3736 cpu_relax();
3737 tmport -= 0x08;
3738 j = inb(tmport);
3739 if (j != 0x16) {
3740 if (j == 0x4e) {
3741 goto widep_out;
3742 }
3743 continue;
3744 }
3745 if (mbuf[0] != 0x01) {
3746 goto not_wide;
3747 }
3748 if (mbuf[1] != 0x02) {
3749 goto not_wide;
3750 }
3751 if (mbuf[2] != 0x03) {
3752 goto not_wide;
3753 }
3754 if (mbuf[3] != 0x01) {
3755 goto not_wide;
3756 }
3757 m = 1;
3758 m = m << i;
3759 dev->wide_id[c] |= m;
3760 not_wide:
3761 if ((dev->id[c][i].devtype == 0x00) || (dev->id[c][i].devtype == 0x07) ||
3762 ((dev->id[c][i].devtype == 0x05) && ((n & 0x10) != 0))) {
3763 m = 1;
3764 m = m << i;
3765 if ((dev->async[c] & m) != 0) {
3766 goto set_sync;
3767 }
3768 }
3769 continue;
3770 set_sync:
3771 if (dev->sp[c][i] == 0x02) {
3772 synu[4]=0x0c;
3773 synuw[4]=0x0c;
3774 } else {
3775 if (dev->sp[c][i] >= 0x03) {
3776 synu[4]=0x0a;
3777 synuw[4]=0x0a;
3778 }
3779 }
3780 tmport = wkport + 0x1b;
3781 j = 0;
3782 if ((m & dev->wide_id[c]) != 0) {
3783 j |= 0x01;
3784 }
3785 outb(j, tmport);
3786 tmport = wkport + 0x03;
3787 outb(satn[0], tmport++);
3788 outb(satn[1], tmport++);
3789 outb(satn[2], tmport++);
3790 outb(satn[3], tmport++);
3791 outb(satn[4], tmport++);
3792 outb(satn[5], tmport++);
3793 tmport += 0x06;
3794 outb(0, tmport);
3795 tmport += 0x02;
3796 outb(dev->id[c][i].devsp, tmport++);
3797 outb(0, tmport++);
3798 outb(satn[6], tmport++);
3799 outb(satn[7], tmport++);
3800 tmport += 0x03;
3801 outb(satn[8], tmport);
3802 tmport += 0x07;
3803
3804 while ((inb(tmport) & 0x80) == 0x00)
3805 cpu_relax();
3806 tmport -= 0x08;
3807 if ((inb(tmport) != 0x11) && (inb(tmport) != 0x8e)) {
3808 continue;
3809 }
3810 while (inb(tmport) != 0x8e)
3811 cpu_relax();
3812 try_sync:
3813 j = 0;
3814 tmport = wkport + 0x14;
3815 outb(0x06, tmport);
3816 tmport += 0x04;
3817 outb(0x20, tmport);
3818 tmport += 0x07;
3819
3820 while ((inb(tmport) & 0x80) == 0) {
3821 if ((inb(tmport) & 0x01) != 0) {
3822 tmport -= 0x06;
3823 if ((m & dev->wide_id[c]) != 0) {
3824 if ((m & dev->ultra_map[c]) != 0) {
3825 outb(synuw[j++], tmport);
3826 } else {
3827 outb(synw[j++], tmport);
3828 }
3829 } else {
3830 if ((m & dev->ultra_map[c]) != 0) {
3831 outb(synu[j++], tmport);
3832 } else {
3833 outb(synn[j++], tmport);
3834 }
3835 }
3836 tmport += 0x06;
3837 }
3838 }
3839 tmport -= 0x08;
3840 while ((inb(tmport) & 0x80) == 0x00)
3841 cpu_relax();
3842 j = inb(tmport) & 0x0f;
3843 if (j == 0x0f) {
3844 goto phase_ins;
3845 }
3846 if (j == 0x0a) {
3847 goto phase_cmds;
3848 }
3849 if (j == 0x0e) {
3850 goto try_sync;
3851 }
3852 continue;
3853 phase_outs:
3854 tmport = wkport + 0x18;
3855 outb(0x20, tmport);
3856 tmport += 0x07;
3857 while ((inb(tmport) & 0x80) == 0x00) {
3858 if ((inb(tmport) & 0x01) != 0x00) {
3859 tmport -= 0x06;
3860 outb(0x00, tmport);
3861 tmport += 0x06;
3862 }
3863 cpu_relax();
3864 }
3865 tmport -= 0x08;
3866 j = inb(tmport);
3867 if (j == 0x85) {
3868 goto tar_dcons;
3869 }
3870 j &= 0x0f;
3871 if (j == 0x0f) {
3872 goto phase_ins;
3873 }
3874 if (j == 0x0a) {
3875 goto phase_cmds;
3876 }
3877 if (j == 0x0e) {
3878 goto phase_outs;
3879 }
3880 continue;
3881 phase_ins:
3882 tmport = wkport + 0x14;
3883 outb(0x06, tmport);
3884 tmport += 0x04;
3885 outb(0x20, tmport);
3886 tmport += 0x07;
3887 k = 0;
3888 phase_ins1:
3889 j = inb(tmport);
3890 if ((j & 0x01) != 0x00) {
3891 tmport -= 0x06;
3892 mbuf[k++] = inb(tmport);
3893 tmport += 0x06;
3894 goto phase_ins1;
3895 }
3896 if ((j & 0x80) == 0x00) {
3897 goto phase_ins1;
3898 }
3899 tmport -= 0x08;
3900 while ((inb(tmport) & 0x80) == 0x00);
3901 j = inb(tmport);
3902 if (j == 0x85) {
3903 goto tar_dcons;
3904 }
3905 j &= 0x0f;
3906 if (j == 0x0f) {
3907 goto phase_ins;
3908 }
3909 if (j == 0x0a) {
3910 goto phase_cmds;
3911 }
3912 if (j == 0x0e) {
3913 goto phase_outs;
3914 }
3915 continue;
3916 phase_cmds:
3917 tmport = wkport + 0x10;
3918 outb(0x30, tmport);
3919 tar_dcons:
3920 tmport = wkport + 0x14;
3921 outb(0x00, tmport);
3922 tmport += 0x04;
3923 outb(0x08, tmport);
3924 tmport += 0x07;
3925 while ((inb(tmport) & 0x80) == 0x00)
3926 cpu_relax();
3927 tmport -= 0x08;
3928 j = inb(tmport);
3929 if (j != 0x16) {
3930 continue;
3931 }
3932 if (mbuf[0] != 0x01) {
3933 continue;
3934 }
3935 if (mbuf[1] != 0x03) {
3936 continue;
3937 }
3938 if (mbuf[4] == 0x00) {
3939 continue;
3940 }
3941 if (mbuf[3] > 0x64) {
3942 continue;
3943 }
3944 if (mbuf[4] > 0x0e) {
3945 mbuf[4] = 0x0e;
3946 }
3947 dev->id[c][i].devsp = mbuf[4];
3948 if (mbuf[3] < 0x0c){
3949 j = 0xb0;
3950 goto set_syn_ok;
3951 }
3952 if ((mbuf[3] < 0x0d) && (rmb == 0)) {
3953 j = 0xa0;
3954 goto set_syn_ok;
3955 }
3956 if (mbuf[3] < 0x1a) {
3957 j = 0x20;
3958 goto set_syn_ok;
3959 }
3960 if (mbuf[3] < 0x33) {
3961 j = 0x40;
3962 goto set_syn_ok;
3963 }
3964 if (mbuf[3] < 0x4c) {
3965 j = 0x50;
3966 goto set_syn_ok;
3967 }
3968 j = 0x60;
3969 set_syn_ok:
3970 dev->id[c][i].devsp = (dev->id[c][i].devsp & 0x0f) | j;
3971 #ifdef ED_DBGP
3972 printk("dev->id[%2d][%2d].devsp = %2x\n",c,i,dev->id[c][i].devsp);
3973 #endif
3974 }
3975 tmport = wkport + 0x16;
3976 outb(0x80, tmport);
3977 }
3978
3979 module_init(atp870u_init);
3980 module_exit(atp870u_exit);
3981
Tomato firmware and modifications.