This source file includes following definitions.
- imm_dev
- got_it
- imm_wakeup
- imm_pb_claim
- imm_pb_dismiss
- imm_pb_release
- imm_write_info
- imm_show_info
- imm_fail_func
- imm_wait
- imm_negotiate
- epp_reset
- ecp_sync
- imm_byte_out
- imm_nibble_in
- imm_byte_in
- imm_out
- imm_in
- imm_cpp
- imm_connect
- imm_disconnect
- imm_select
- imm_init
- imm_send_command
- imm_completion
- imm_interrupt
- imm_engine
- imm_queuecommand_lck
- DEF_SCSI_QCMD
- imm_abort
- imm_reset_pulse
- imm_reset
- device_check
- imm_adjust_queue
- find_parent
- __imm_attach
- imm_attach
- imm_detach
- imm_driver_init
- imm_driver_exit
1
2
3
4
5
6
7
8
9
10
11
12 #include <linux/init.h>
13 #include <linux/kernel.h>
14 #include <linux/module.h>
15 #include <linux/blkdev.h>
16 #include <linux/parport.h>
17 #include <linux/workqueue.h>
18 #include <linux/delay.h>
19 #include <linux/slab.h>
20 #include <asm/io.h>
21
22 #include <scsi/scsi.h>
23 #include <scsi/scsi_cmnd.h>
24 #include <scsi/scsi_device.h>
25 #include <scsi/scsi_host.h>
26
27
28 #define IMM_PROBE_SPP 0x0001
29 #define IMM_PROBE_PS2 0x0002
30 #define IMM_PROBE_ECR 0x0010
31 #define IMM_PROBE_EPP17 0x0100
32 #define IMM_PROBE_EPP19 0x0200
33
34
35 typedef struct {
36 struct pardevice *dev;
37 int base;
38 int base_hi;
39 int mode;
40 struct scsi_cmnd *cur_cmd;
41 struct delayed_work imm_tq;
42 unsigned long jstart;
43 unsigned failed:1;
44 unsigned dp:1;
45 unsigned rd:1;
46 unsigned wanted:1;
47 unsigned int dev_no;
48 wait_queue_head_t *waiting;
49 struct Scsi_Host *host;
50 struct list_head list;
51 } imm_struct;
52
53 static void imm_reset_pulse(unsigned int base);
54 static int device_check(imm_struct *dev);
55
56 #include "imm.h"
57
58 static inline imm_struct *imm_dev(struct Scsi_Host *host)
59 {
60 return *(imm_struct **)&host->hostdata;
61 }
62
63 static DEFINE_SPINLOCK(arbitration_lock);
64
65 static void got_it(imm_struct *dev)
66 {
67 dev->base = dev->dev->port->base;
68 if (dev->cur_cmd)
69 dev->cur_cmd->SCp.phase = 1;
70 else
71 wake_up(dev->waiting);
72 }
73
74 static void imm_wakeup(void *ref)
75 {
76 imm_struct *dev = (imm_struct *) ref;
77 unsigned long flags;
78
79 spin_lock_irqsave(&arbitration_lock, flags);
80 if (dev->wanted) {
81 if (parport_claim(dev->dev) == 0) {
82 got_it(dev);
83 dev->wanted = 0;
84 }
85 }
86 spin_unlock_irqrestore(&arbitration_lock, flags);
87 }
88
89 static int imm_pb_claim(imm_struct *dev)
90 {
91 unsigned long flags;
92 int res = 1;
93 spin_lock_irqsave(&arbitration_lock, flags);
94 if (parport_claim(dev->dev) == 0) {
95 got_it(dev);
96 res = 0;
97 }
98 dev->wanted = res;
99 spin_unlock_irqrestore(&arbitration_lock, flags);
100 return res;
101 }
102
103 static void imm_pb_dismiss(imm_struct *dev)
104 {
105 unsigned long flags;
106 int wanted;
107 spin_lock_irqsave(&arbitration_lock, flags);
108 wanted = dev->wanted;
109 dev->wanted = 0;
110 spin_unlock_irqrestore(&arbitration_lock, flags);
111 if (!wanted)
112 parport_release(dev->dev);
113 }
114
115 static inline void imm_pb_release(imm_struct *dev)
116 {
117 parport_release(dev->dev);
118 }
119
120
121
122
123
124
125
126
127 static int imm_write_info(struct Scsi_Host *host, char *buffer, int length)
128 {
129 imm_struct *dev = imm_dev(host);
130
131 if ((length > 5) && (strncmp(buffer, "mode=", 5) == 0)) {
132 dev->mode = simple_strtoul(buffer + 5, NULL, 0);
133 return length;
134 }
135 printk("imm /proc: invalid variable\n");
136 return -EINVAL;
137 }
138
139 static int imm_show_info(struct seq_file *m, struct Scsi_Host *host)
140 {
141 imm_struct *dev = imm_dev(host);
142
143 seq_printf(m, "Version : %s\n", IMM_VERSION);
144 seq_printf(m, "Parport : %s\n", dev->dev->port->name);
145 seq_printf(m, "Mode : %s\n", IMM_MODE_STRING[dev->mode]);
146 return 0;
147 }
148
149 #if IMM_DEBUG > 0
150 #define imm_fail(x,y) printk("imm: imm_fail(%i) from %s at line %d\n",\
151 y, __func__, __LINE__); imm_fail_func(x,y);
152 static inline void
153 imm_fail_func(imm_struct *dev, int error_code)
154 #else
155 static inline void
156 imm_fail(imm_struct *dev, int error_code)
157 #endif
158 {
159
160 if (dev->cur_cmd) {
161 dev->cur_cmd->result = error_code << 16;
162 dev->failed = 1;
163 }
164 }
165
166
167
168
169
170
171
172
173 static unsigned char imm_wait(imm_struct *dev)
174 {
175 int k;
176 unsigned short ppb = dev->base;
177 unsigned char r;
178
179 w_ctr(ppb, 0x0c);
180
181 k = IMM_SPIN_TMO;
182 do {
183 r = r_str(ppb);
184 k--;
185 udelay(1);
186 }
187 while (!(r & 0x80) && (k));
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208 w_ctr(ppb, 0x04);
209 if (k)
210 return (r & 0xb8);
211
212
213 imm_fail(dev, DID_TIME_OUT);
214 printk("imm timeout in imm_wait\n");
215 return 0;
216 }
217
218 static int imm_negotiate(imm_struct * tmp)
219 {
220
221
222
223
224
225
226
227
228
229
230
231
232 unsigned short base = tmp->base;
233 unsigned char a, mode;
234
235 switch (tmp->mode) {
236 case IMM_NIBBLE:
237 mode = 0x00;
238 break;
239 case IMM_PS2:
240 mode = 0x01;
241 break;
242 default:
243 return 0;
244 }
245
246 w_ctr(base, 0x04);
247 udelay(5);
248 w_dtr(base, mode);
249 udelay(100);
250 w_ctr(base, 0x06);
251 udelay(5);
252 a = (r_str(base) & 0x20) ? 0 : 1;
253 udelay(5);
254 w_ctr(base, 0x07);
255 udelay(5);
256 w_ctr(base, 0x06);
257
258 if (a) {
259 printk
260 ("IMM: IEEE1284 negotiate indicates no data available.\n");
261 imm_fail(tmp, DID_ERROR);
262 }
263 return a;
264 }
265
266
267
268
269 static inline void epp_reset(unsigned short ppb)
270 {
271 int i;
272
273 i = r_str(ppb);
274 w_str(ppb, i);
275 w_str(ppb, i & 0xfe);
276 }
277
278
279
280
281 static inline void ecp_sync(imm_struct *dev)
282 {
283 int i, ppb_hi = dev->base_hi;
284
285 if (ppb_hi == 0)
286 return;
287
288 if ((r_ecr(ppb_hi) & 0xe0) == 0x60) {
289 for (i = 0; i < 100; i++) {
290 if (r_ecr(ppb_hi) & 0x01)
291 return;
292 udelay(5);
293 }
294 printk("imm: ECP sync failed as data still present in FIFO.\n");
295 }
296 }
297
298 static int imm_byte_out(unsigned short base, const char *buffer, int len)
299 {
300 int i;
301
302 w_ctr(base, 0x4);
303 for (i = len >> 1; i; i--) {
304 w_dtr(base, *buffer++);
305 w_ctr(base, 0x5);
306 w_dtr(base, *buffer++);
307 w_ctr(base, 0x0);
308 }
309 w_ctr(base, 0x4);
310 return 1;
311 }
312
313 static int imm_nibble_in(unsigned short base, char *buffer, int len)
314 {
315 unsigned char l;
316 int i;
317
318
319
320
321 w_ctr(base, 0x4);
322 for (i = len; i; i--) {
323 w_ctr(base, 0x6);
324 l = (r_str(base) & 0xf0) >> 4;
325 w_ctr(base, 0x5);
326 *buffer++ = (r_str(base) & 0xf0) | l;
327 w_ctr(base, 0x4);
328 }
329 return 1;
330 }
331
332 static int imm_byte_in(unsigned short base, char *buffer, int len)
333 {
334 int i;
335
336
337
338
339 w_ctr(base, 0x4);
340 for (i = len; i; i--) {
341 w_ctr(base, 0x26);
342 *buffer++ = r_dtr(base);
343 w_ctr(base, 0x25);
344 }
345 return 1;
346 }
347
348 static int imm_out(imm_struct *dev, char *buffer, int len)
349 {
350 unsigned short ppb = dev->base;
351 int r = imm_wait(dev);
352
353
354
355
356
357
358 if ((r & 0x18) != 0x08) {
359 imm_fail(dev, DID_ERROR);
360 printk("IMM: returned SCSI status %2x\n", r);
361 return 0;
362 }
363 switch (dev->mode) {
364 case IMM_EPP_32:
365 case IMM_EPP_16:
366 case IMM_EPP_8:
367 epp_reset(ppb);
368 w_ctr(ppb, 0x4);
369 #ifdef CONFIG_SCSI_IZIP_EPP16
370 if (!(((long) buffer | len) & 0x01))
371 outsw(ppb + 4, buffer, len >> 1);
372 #else
373 if (!(((long) buffer | len) & 0x03))
374 outsl(ppb + 4, buffer, len >> 2);
375 #endif
376 else
377 outsb(ppb + 4, buffer, len);
378 w_ctr(ppb, 0xc);
379 r = !(r_str(ppb) & 0x01);
380 w_ctr(ppb, 0xc);
381 ecp_sync(dev);
382 break;
383
384 case IMM_NIBBLE:
385 case IMM_PS2:
386
387 r = imm_byte_out(ppb, buffer, len);
388 break;
389
390 default:
391 printk("IMM: bug in imm_out()\n");
392 r = 0;
393 }
394 return r;
395 }
396
397 static int imm_in(imm_struct *dev, char *buffer, int len)
398 {
399 unsigned short ppb = dev->base;
400 int r = imm_wait(dev);
401
402
403
404
405
406
407 if ((r & 0x18) != 0x18) {
408 imm_fail(dev, DID_ERROR);
409 return 0;
410 }
411 switch (dev->mode) {
412 case IMM_NIBBLE:
413
414 r = imm_nibble_in(ppb, buffer, len);
415 w_ctr(ppb, 0xc);
416 break;
417
418 case IMM_PS2:
419
420 r = imm_byte_in(ppb, buffer, len);
421 w_ctr(ppb, 0xc);
422 break;
423
424 case IMM_EPP_32:
425 case IMM_EPP_16:
426 case IMM_EPP_8:
427 epp_reset(ppb);
428 w_ctr(ppb, 0x24);
429 #ifdef CONFIG_SCSI_IZIP_EPP16
430 if (!(((long) buffer | len) & 0x01))
431 insw(ppb + 4, buffer, len >> 1);
432 #else
433 if (!(((long) buffer | len) & 0x03))
434 insl(ppb + 4, buffer, len >> 2);
435 #endif
436 else
437 insb(ppb + 4, buffer, len);
438 w_ctr(ppb, 0x2c);
439 r = !(r_str(ppb) & 0x01);
440 w_ctr(ppb, 0x2c);
441 ecp_sync(dev);
442 break;
443
444 default:
445 printk("IMM: bug in imm_ins()\n");
446 r = 0;
447 break;
448 }
449 return r;
450 }
451
452 static int imm_cpp(unsigned short ppb, unsigned char b)
453 {
454
455
456
457
458
459 unsigned char s1, s2, s3;
460 w_ctr(ppb, 0x0c);
461 udelay(2);
462 w_dtr(ppb, 0xaa);
463 udelay(10);
464 w_dtr(ppb, 0x55);
465 udelay(10);
466 w_dtr(ppb, 0x00);
467 udelay(10);
468 w_dtr(ppb, 0xff);
469 udelay(10);
470 s1 = r_str(ppb) & 0xb8;
471 w_dtr(ppb, 0x87);
472 udelay(10);
473 s2 = r_str(ppb) & 0xb8;
474 w_dtr(ppb, 0x78);
475 udelay(10);
476 s3 = r_str(ppb) & 0x38;
477
478
479
480
481
482
483
484
485
486
487 w_dtr(ppb, b);
488 udelay(2);
489 w_ctr(ppb, 0x0c);
490 udelay(10);
491 w_ctr(ppb, 0x0d);
492 udelay(2);
493 w_ctr(ppb, 0x0c);
494 udelay(10);
495 w_dtr(ppb, 0xff);
496 udelay(10);
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514 if ((s1 == 0xb8) && (s2 == 0x18) && (s3 == 0x30))
515 return 1;
516 if ((s1 == 0xb8) && (s2 == 0x18) && (s3 == 0x38))
517 return 0;
518
519 return -1;
520 }
521
522 static inline int imm_connect(imm_struct *dev, int flag)
523 {
524 unsigned short ppb = dev->base;
525
526 imm_cpp(ppb, 0xe0);
527 imm_cpp(ppb, 0x30);
528
529 if ((dev->mode == IMM_EPP_8) ||
530 (dev->mode == IMM_EPP_16) ||
531 (dev->mode == IMM_EPP_32))
532 return imm_cpp(ppb, 0x28);
533 return imm_cpp(ppb, 0xe0);
534 }
535
536 static void imm_disconnect(imm_struct *dev)
537 {
538 imm_cpp(dev->base, 0x30);
539 }
540
541 static int imm_select(imm_struct *dev, int target)
542 {
543 int k;
544 unsigned short ppb = dev->base;
545
546
547
548
549
550 w_ctr(ppb, 0xc);
551
552 k = IMM_SELECT_TMO;
553 do {
554 k--;
555 } while ((r_str(ppb) & 0x08) && (k));
556
557 if (!k)
558 return 0;
559
560
561
562
563 w_ctr(ppb, 0x4);
564 w_dtr(ppb, 0x80 | (1 << target));
565 udelay(1);
566
567
568
569
570 w_ctr(ppb, 0xc);
571 w_ctr(ppb, 0xd);
572
573
574
575
576
577 k = IMM_SELECT_TMO;
578 do {
579 k--;
580 }
581 while (!(r_str(ppb) & 0x08) && (k));
582
583
584
585
586 w_ctr(ppb, 0xc);
587 return (k) ? 1 : 0;
588 }
589
590 static int imm_init(imm_struct *dev)
591 {
592 if (imm_connect(dev, 0) != 1)
593 return -EIO;
594 imm_reset_pulse(dev->base);
595 mdelay(1);
596 imm_disconnect(dev);
597 mdelay(1);
598 return device_check(dev);
599 }
600
601 static inline int imm_send_command(struct scsi_cmnd *cmd)
602 {
603 imm_struct *dev = imm_dev(cmd->device->host);
604 int k;
605
606
607 for (k = 0; k < cmd->cmd_len; k += 2)
608 if (!imm_out(dev, &cmd->cmnd[k], 2))
609 return 0;
610 return 1;
611 }
612
613
614
615
616
617
618
619
620
621 static int imm_completion(struct scsi_cmnd *cmd)
622 {
623
624
625
626
627
628 imm_struct *dev = imm_dev(cmd->device->host);
629 unsigned short ppb = dev->base;
630 unsigned long start_jiffies = jiffies;
631
632 unsigned char r, v;
633 int fast, bulk, status;
634
635 v = cmd->cmnd[0];
636 bulk = ((v == READ_6) ||
637 (v == READ_10) || (v == WRITE_6) || (v == WRITE_10));
638
639
640
641
642
643 w_ctr(ppb, 0x0c);
644 r = (r_str(ppb) & 0xb8);
645
646
647
648
649
650 while (r != (unsigned char) 0xb8) {
651
652
653
654
655 if (time_after(jiffies, start_jiffies + 1))
656 return 0;
657
658
659
660
661
662
663 if (((r & 0x88) != 0x88) || (cmd->SCp.this_residual <= 0)) {
664 imm_fail(dev, DID_ERROR);
665 return -1;
666 }
667
668 if (dev->rd == 0) {
669 fast = (bulk
670 && (cmd->SCp.this_residual >=
671 IMM_BURST_SIZE)) ? IMM_BURST_SIZE : 2;
672 status = imm_out(dev, cmd->SCp.ptr, fast);
673 } else {
674 fast = (bulk
675 && (cmd->SCp.this_residual >=
676 IMM_BURST_SIZE)) ? IMM_BURST_SIZE : 1;
677 status = imm_in(dev, cmd->SCp.ptr, fast);
678 }
679
680 cmd->SCp.ptr += fast;
681 cmd->SCp.this_residual -= fast;
682
683 if (!status) {
684 imm_fail(dev, DID_BUS_BUSY);
685 return -1;
686 }
687 if (cmd->SCp.buffer && !cmd->SCp.this_residual) {
688
689 if (cmd->SCp.buffers_residual--) {
690 cmd->SCp.buffer = sg_next(cmd->SCp.buffer);
691 cmd->SCp.this_residual =
692 cmd->SCp.buffer->length;
693 cmd->SCp.ptr = sg_virt(cmd->SCp.buffer);
694
695
696
697
698
699 if (cmd->SCp.this_residual & 0x01)
700 cmd->SCp.this_residual++;
701 }
702 }
703
704 w_ctr(ppb, 0x0c);
705 r = (r_str(ppb) & 0xb8);
706
707
708 if (!(r & 0x80))
709 return 0;
710 }
711 return 1;
712 }
713
714
715
716
717
718
719 static void imm_interrupt(struct work_struct *work)
720 {
721 imm_struct *dev = container_of(work, imm_struct, imm_tq.work);
722 struct scsi_cmnd *cmd = dev->cur_cmd;
723 struct Scsi_Host *host = cmd->device->host;
724 unsigned long flags;
725
726 if (imm_engine(dev, cmd)) {
727 schedule_delayed_work(&dev->imm_tq, 1);
728 return;
729 }
730
731 #if IMM_DEBUG > 0
732 switch ((cmd->result >> 16) & 0xff) {
733 case DID_OK:
734 break;
735 case DID_NO_CONNECT:
736 printk("imm: no device at SCSI ID %i\n", cmd->device->id);
737 break;
738 case DID_BUS_BUSY:
739 printk("imm: BUS BUSY - EPP timeout detected\n");
740 break;
741 case DID_TIME_OUT:
742 printk("imm: unknown timeout\n");
743 break;
744 case DID_ABORT:
745 printk("imm: told to abort\n");
746 break;
747 case DID_PARITY:
748 printk("imm: parity error (???)\n");
749 break;
750 case DID_ERROR:
751 printk("imm: internal driver error\n");
752 break;
753 case DID_RESET:
754 printk("imm: told to reset device\n");
755 break;
756 case DID_BAD_INTR:
757 printk("imm: bad interrupt (???)\n");
758 break;
759 default:
760 printk("imm: bad return code (%02x)\n",
761 (cmd->result >> 16) & 0xff);
762 }
763 #endif
764
765 if (cmd->SCp.phase > 1)
766 imm_disconnect(dev);
767
768 imm_pb_dismiss(dev);
769
770 spin_lock_irqsave(host->host_lock, flags);
771 dev->cur_cmd = NULL;
772 cmd->scsi_done(cmd);
773 spin_unlock_irqrestore(host->host_lock, flags);
774 return;
775 }
776
777 static int imm_engine(imm_struct *dev, struct scsi_cmnd *cmd)
778 {
779 unsigned short ppb = dev->base;
780 unsigned char l = 0, h = 0;
781 int retv, x;
782
783
784
785
786 if (dev->failed)
787 return 0;
788
789 switch (cmd->SCp.phase) {
790 case 0:
791 if (time_after(jiffies, dev->jstart + HZ)) {
792
793
794
795
796 imm_fail(dev, DID_BUS_BUSY);
797 return 0;
798 }
799 return 1;
800
801 case 1:
802 imm_connect(dev, CONNECT_EPP_MAYBE);
803 cmd->SCp.phase++;
804
805
806 case 2:
807 if (!imm_select(dev, scmd_id(cmd))) {
808 imm_fail(dev, DID_NO_CONNECT);
809 return 0;
810 }
811 cmd->SCp.phase++;
812
813
814 case 3:
815 w_ctr(ppb, 0x0c);
816 if (!(r_str(ppb) & 0x80))
817 return 1;
818
819 if (!imm_send_command(cmd))
820 return 0;
821 cmd->SCp.phase++;
822
823
824 case 4:
825 if (scsi_bufflen(cmd)) {
826 cmd->SCp.buffer = scsi_sglist(cmd);
827 cmd->SCp.this_residual = cmd->SCp.buffer->length;
828 cmd->SCp.ptr = sg_virt(cmd->SCp.buffer);
829 } else {
830 cmd->SCp.buffer = NULL;
831 cmd->SCp.this_residual = 0;
832 cmd->SCp.ptr = NULL;
833 }
834 cmd->SCp.buffers_residual = scsi_sg_count(cmd) - 1;
835 cmd->SCp.phase++;
836 if (cmd->SCp.this_residual & 0x01)
837 cmd->SCp.this_residual++;
838
839
840 case 5:
841
842 w_ctr(ppb, 0x0c);
843 if (!(r_str(ppb) & 0x80))
844 return 1;
845
846
847 x = (r_str(ppb) & 0xb8);
848 dev->rd = (x & 0x10) ? 1 : 0;
849 dev->dp = (x & 0x20) ? 0 : 1;
850
851 if ((dev->dp) && (dev->rd))
852 if (imm_negotiate(dev))
853 return 0;
854 cmd->SCp.phase++;
855
856
857 case 6:
858
859 w_ctr(ppb, 0x0c);
860 if (!(r_str(ppb) & 0x80))
861 return 1;
862
863 if (dev->dp) {
864 retv = imm_completion(cmd);
865 if (retv == -1)
866 return 0;
867 if (retv == 0)
868 return 1;
869 }
870 cmd->SCp.phase++;
871
872
873 case 7:
874 if ((dev->dp) && (dev->rd)) {
875 if ((dev->mode == IMM_NIBBLE) || (dev->mode == IMM_PS2)) {
876 w_ctr(ppb, 0x4);
877 w_ctr(ppb, 0xc);
878 w_ctr(ppb, 0xe);
879 w_ctr(ppb, 0x4);
880 }
881 }
882 cmd->SCp.phase++;
883
884
885 case 8:
886
887 if (imm_wait(dev) != (unsigned char) 0xb8) {
888 imm_fail(dev, DID_ERROR);
889 return 0;
890 }
891 if (imm_negotiate(dev))
892 return 0;
893 if (imm_in(dev, &l, 1)) {
894
895 if (imm_wait(dev) == (unsigned char) 0xb8)
896 imm_in(dev, &h, 1);
897 cmd->result = (DID_OK << 16) | (l & STATUS_MASK);
898 }
899 if ((dev->mode == IMM_NIBBLE) || (dev->mode == IMM_PS2)) {
900 w_ctr(ppb, 0x4);
901 w_ctr(ppb, 0xc);
902 w_ctr(ppb, 0xe);
903 w_ctr(ppb, 0x4);
904 }
905 return 0;
906 break;
907
908 default:
909 printk("imm: Invalid scsi phase\n");
910 }
911 return 0;
912 }
913
914 static int imm_queuecommand_lck(struct scsi_cmnd *cmd,
915 void (*done)(struct scsi_cmnd *))
916 {
917 imm_struct *dev = imm_dev(cmd->device->host);
918
919 if (dev->cur_cmd) {
920 printk("IMM: bug in imm_queuecommand\n");
921 return 0;
922 }
923 dev->failed = 0;
924 dev->jstart = jiffies;
925 dev->cur_cmd = cmd;
926 cmd->scsi_done = done;
927 cmd->result = DID_ERROR << 16;
928 cmd->SCp.phase = 0;
929
930 schedule_delayed_work(&dev->imm_tq, 0);
931
932 imm_pb_claim(dev);
933
934 return 0;
935 }
936
937 static DEF_SCSI_QCMD(imm_queuecommand)
938
939
940
941
942
943
944
945 static int imm_biosparam(struct scsi_device *sdev, struct block_device *dev,
946 sector_t capacity, int ip[])
947 {
948 ip[0] = 0x40;
949 ip[1] = 0x20;
950 ip[2] = ((unsigned long) capacity + 1) / (ip[0] * ip[1]);
951 if (ip[2] > 1024) {
952 ip[0] = 0xff;
953 ip[1] = 0x3f;
954 ip[2] = ((unsigned long) capacity + 1) / (ip[0] * ip[1]);
955 }
956 return 0;
957 }
958
959 static int imm_abort(struct scsi_cmnd *cmd)
960 {
961 imm_struct *dev = imm_dev(cmd->device->host);
962
963
964
965
966
967 switch (cmd->SCp.phase) {
968 case 0:
969 case 1:
970 dev->cur_cmd = NULL;
971 return SUCCESS;
972 break;
973 default:
974 return FAILED;
975 break;
976 }
977 }
978
979 static void imm_reset_pulse(unsigned int base)
980 {
981 w_ctr(base, 0x04);
982 w_dtr(base, 0x40);
983 udelay(1);
984 w_ctr(base, 0x0c);
985 w_ctr(base, 0x0d);
986 udelay(50);
987 w_ctr(base, 0x0c);
988 w_ctr(base, 0x04);
989 }
990
991 static int imm_reset(struct scsi_cmnd *cmd)
992 {
993 imm_struct *dev = imm_dev(cmd->device->host);
994
995 if (cmd->SCp.phase)
996 imm_disconnect(dev);
997 dev->cur_cmd = NULL;
998
999 imm_connect(dev, CONNECT_NORMAL);
1000 imm_reset_pulse(dev->base);
1001 mdelay(1);
1002 imm_disconnect(dev);
1003 mdelay(1);
1004 return SUCCESS;
1005 }
1006
1007 static int device_check(imm_struct *dev)
1008 {
1009
1010
1011
1012 static char cmd[6] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
1013 int loop, old_mode, status, k, ppb = dev->base;
1014 unsigned char l;
1015
1016 old_mode = dev->mode;
1017 for (loop = 0; loop < 8; loop++) {
1018
1019 if ((ppb & 0x0007) == 0x0000)
1020 dev->mode = IMM_EPP_32;
1021
1022 second_pass:
1023 imm_connect(dev, CONNECT_EPP_MAYBE);
1024
1025 if (!imm_select(dev, loop)) {
1026 imm_disconnect(dev);
1027 continue;
1028 }
1029 printk("imm: Found device at ID %i, Attempting to use %s\n",
1030 loop, IMM_MODE_STRING[dev->mode]);
1031
1032
1033 status = 1;
1034 w_ctr(ppb, 0x0c);
1035 for (l = 0; (l < 3) && (status); l++)
1036 status = imm_out(dev, &cmd[l << 1], 2);
1037
1038 if (!status) {
1039 imm_disconnect(dev);
1040 imm_connect(dev, CONNECT_EPP_MAYBE);
1041 imm_reset_pulse(dev->base);
1042 udelay(1000);
1043 imm_disconnect(dev);
1044 udelay(1000);
1045 if (dev->mode == IMM_EPP_32) {
1046 dev->mode = old_mode;
1047 goto second_pass;
1048 }
1049 printk("imm: Unable to establish communication\n");
1050 return -EIO;
1051 }
1052 w_ctr(ppb, 0x0c);
1053
1054 k = 1000000;
1055 do {
1056 l = r_str(ppb);
1057 k--;
1058 udelay(1);
1059 } while (!(l & 0x80) && (k));
1060
1061 l &= 0xb8;
1062
1063 if (l != 0xb8) {
1064 imm_disconnect(dev);
1065 imm_connect(dev, CONNECT_EPP_MAYBE);
1066 imm_reset_pulse(dev->base);
1067 udelay(1000);
1068 imm_disconnect(dev);
1069 udelay(1000);
1070 if (dev->mode == IMM_EPP_32) {
1071 dev->mode = old_mode;
1072 goto second_pass;
1073 }
1074 printk
1075 ("imm: Unable to establish communication\n");
1076 return -EIO;
1077 }
1078 imm_disconnect(dev);
1079 printk
1080 ("imm: Communication established at 0x%x with ID %i using %s\n",
1081 ppb, loop, IMM_MODE_STRING[dev->mode]);
1082 imm_connect(dev, CONNECT_EPP_MAYBE);
1083 imm_reset_pulse(dev->base);
1084 udelay(1000);
1085 imm_disconnect(dev);
1086 udelay(1000);
1087 return 0;
1088 }
1089 printk("imm: No devices found\n");
1090 return -ENODEV;
1091 }
1092
1093
1094
1095
1096
1097 static int imm_adjust_queue(struct scsi_device *device)
1098 {
1099 blk_queue_bounce_limit(device->request_queue, BLK_BOUNCE_HIGH);
1100 return 0;
1101 }
1102
1103 static struct scsi_host_template imm_template = {
1104 .module = THIS_MODULE,
1105 .proc_name = "imm",
1106 .show_info = imm_show_info,
1107 .write_info = imm_write_info,
1108 .name = "Iomega VPI2 (imm) interface",
1109 .queuecommand = imm_queuecommand,
1110 .eh_abort_handler = imm_abort,
1111 .eh_host_reset_handler = imm_reset,
1112 .bios_param = imm_biosparam,
1113 .this_id = 7,
1114 .sg_tablesize = SG_ALL,
1115 .can_queue = 1,
1116 .slave_alloc = imm_adjust_queue,
1117 };
1118
1119
1120
1121
1122
1123 static LIST_HEAD(imm_hosts);
1124
1125
1126
1127
1128
1129
1130
1131 static inline imm_struct *find_parent(void)
1132 {
1133 imm_struct *dev, *par = NULL;
1134 unsigned int cnt = 0;
1135
1136 if (list_empty(&imm_hosts))
1137 return NULL;
1138
1139 list_for_each_entry(dev, &imm_hosts, list) {
1140 if (dev->dev_no != cnt)
1141 return par;
1142 cnt++;
1143 par = dev;
1144 }
1145
1146 return par;
1147 }
1148
1149 static int __imm_attach(struct parport *pb)
1150 {
1151 struct Scsi_Host *host;
1152 imm_struct *dev, *temp;
1153 DECLARE_WAIT_QUEUE_HEAD_ONSTACK(waiting);
1154 DEFINE_WAIT(wait);
1155 int ports;
1156 int modes, ppb;
1157 int err = -ENOMEM;
1158 struct pardev_cb imm_cb;
1159
1160 init_waitqueue_head(&waiting);
1161
1162 dev = kzalloc(sizeof(imm_struct), GFP_KERNEL);
1163 if (!dev)
1164 return -ENOMEM;
1165
1166
1167 dev->base = -1;
1168 dev->mode = IMM_AUTODETECT;
1169 INIT_LIST_HEAD(&dev->list);
1170
1171 temp = find_parent();
1172 if (temp)
1173 dev->dev_no = temp->dev_no + 1;
1174
1175 memset(&imm_cb, 0, sizeof(imm_cb));
1176 imm_cb.private = dev;
1177 imm_cb.wakeup = imm_wakeup;
1178
1179 dev->dev = parport_register_dev_model(pb, "imm", &imm_cb, dev->dev_no);
1180 if (!dev->dev)
1181 goto out;
1182
1183
1184
1185
1186
1187 err = -EBUSY;
1188 dev->waiting = &waiting;
1189 prepare_to_wait(&waiting, &wait, TASK_UNINTERRUPTIBLE);
1190 if (imm_pb_claim(dev))
1191 schedule_timeout(3 * HZ);
1192 if (dev->wanted) {
1193 printk(KERN_ERR "imm%d: failed to claim parport because "
1194 "a pardevice is owning the port for too long "
1195 "time!\n", pb->number);
1196 imm_pb_dismiss(dev);
1197 dev->waiting = NULL;
1198 finish_wait(&waiting, &wait);
1199 goto out1;
1200 }
1201 dev->waiting = NULL;
1202 finish_wait(&waiting, &wait);
1203 ppb = dev->base = dev->dev->port->base;
1204 dev->base_hi = dev->dev->port->base_hi;
1205 w_ctr(ppb, 0x0c);
1206 modes = dev->dev->port->modes;
1207
1208
1209
1210
1211 dev->mode = IMM_NIBBLE;
1212
1213 if (modes & PARPORT_MODE_TRISTATE)
1214 dev->mode = IMM_PS2;
1215
1216
1217
1218 err = imm_init(dev);
1219
1220 imm_pb_release(dev);
1221
1222 if (err)
1223 goto out1;
1224
1225
1226 if (dev->mode == IMM_NIBBLE || dev->mode == IMM_PS2)
1227 ports = 3;
1228 else
1229 ports = 8;
1230
1231 INIT_DELAYED_WORK(&dev->imm_tq, imm_interrupt);
1232
1233 err = -ENOMEM;
1234 host = scsi_host_alloc(&imm_template, sizeof(imm_struct *));
1235 if (!host)
1236 goto out1;
1237 host->io_port = pb->base;
1238 host->n_io_port = ports;
1239 host->dma_channel = -1;
1240 host->unique_id = pb->number;
1241 *(imm_struct **)&host->hostdata = dev;
1242 dev->host = host;
1243 if (!temp)
1244 list_add_tail(&dev->list, &imm_hosts);
1245 else
1246 list_add_tail(&dev->list, &temp->list);
1247 err = scsi_add_host(host, NULL);
1248 if (err)
1249 goto out2;
1250 scsi_scan_host(host);
1251 return 0;
1252
1253 out2:
1254 list_del_init(&dev->list);
1255 scsi_host_put(host);
1256 out1:
1257 parport_unregister_device(dev->dev);
1258 out:
1259 kfree(dev);
1260 return err;
1261 }
1262
1263 static void imm_attach(struct parport *pb)
1264 {
1265 __imm_attach(pb);
1266 }
1267
1268 static void imm_detach(struct parport *pb)
1269 {
1270 imm_struct *dev;
1271 list_for_each_entry(dev, &imm_hosts, list) {
1272 if (dev->dev->port == pb) {
1273 list_del_init(&dev->list);
1274 scsi_remove_host(dev->host);
1275 scsi_host_put(dev->host);
1276 parport_unregister_device(dev->dev);
1277 kfree(dev);
1278 break;
1279 }
1280 }
1281 }
1282
1283 static struct parport_driver imm_driver = {
1284 .name = "imm",
1285 .match_port = imm_attach,
1286 .detach = imm_detach,
1287 .devmodel = true,
1288 };
1289
1290 static int __init imm_driver_init(void)
1291 {
1292 printk("imm: Version %s\n", IMM_VERSION);
1293 return parport_register_driver(&imm_driver);
1294 }
1295
1296 static void __exit imm_driver_exit(void)
1297 {
1298 parport_unregister_driver(&imm_driver);
1299 }
1300
1301 module_init(imm_driver_init);
1302 module_exit(imm_driver_exit);
1303
1304 MODULE_LICENSE("GPL");