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