pcmcia: CompactFlash driver for PA Semi Electra boards
[pv_ops_mirror.git] / drivers / scsi / arm / acornscsi-io.S
blob93467e6ac9239c60c508195a895b9753a2b9d27e
1 /*
2  *  linux/drivers/acorn/scsi/acornscsi-io.S: Acorn SCSI card IO
3  *
4  * This program is free software; you can redistribute it and/or modify
5  * it under the terms of the GNU General Public License version 2 as
6  * published by the Free Software Foundation.
7  */
8 #include <linux/linkage.h>
10 #include <asm/assembler.h>
11 #include <asm/hardware.h>
13 #if (IO_BASE == (PCIO_BASE & 0xff000000))
14 #define ADDR(off,reg)                                           \
15                 tst     off, $0x80000000                        ;\
16                 mov     reg, $IO_BASE                           ;\
17                 orreq   reg, reg, $(PCIO_BASE & 0x00ff0000)
18 #else
19 #define ADDR(off,reg)                                           \
20                 tst     off, $0x80000000                        ;\
21                 movne   reg, $IO_BASE                           ;\
22                 moveq   reg, $(PCIO_BASE & 0xff000000)          ;\
23                 orreq   reg, reg, $(PCIO_BASE & 0x00ff0000)
24 #endif
26 @ Purpose: transfer a block of data from the acorn scsi card to memory
27 @ Proto  : void acornscsi_in(unsigned int addr_start, char *buffer, int length)
28 @ Returns: nothing
30                 .align
31 ENTRY(__acornscsi_in)
32                 stmfd   sp!, {r4 - r7, lr}
33                 bic     r0, r0, #3
34                 mov     lr, #0xff
35                 orr     lr, lr, #0xff00
36 acornscsi_in16lp:
37                 subs    r2, r2, #16
38                 bmi     acornscsi_in8
39                 ldmia   r0!, {r3, r4, r5, r6}
40                 and     r3, r3, lr
41                 orr     r3, r3, r4, lsl #16
42                 and     r4, r5, lr
43                 orr     r4, r4, r6, lsl #16
44                 ldmia   r0!, {r5, r6, r7, ip}
45                 and     r5, r5, lr
46                 orr     r5, r5, r6, lsl #16
47                 and     r6, r7, lr
48                 orr     r6, r6, ip, lsl #16
49                 stmia   r1!, {r3 - r6}
50                 bne     acornscsi_in16lp
51                 LOADREGS(fd, sp!, {r4 - r7, pc})
53 acornscsi_in8:  adds    r2, r2, #8
54                 bmi     acornscsi_in4
55                 ldmia   r0!, {r3, r4, r5, r6}
56                 and     r3, r3, lr
57                 orr     r3, r3, r4, lsl #16
58                 and     r4, r5, lr
59                 orr     r4, r4, r6, lsl #16
60                 stmia   r1!, {r3 - r4}
61                 LOADREGS(eqfd, sp!, {r4 - r7, pc})
62                 sub     r2, r2, #8
64 acornscsi_in4:  adds    r2, r2, #4
65                 bmi     acornscsi_in2
66                 ldmia   r0!, {r3, r4}
67                 and     r3, r3, lr
68                 orr     r3, r3, r4, lsl #16
69                 str     r3, [r1], #4
70                 LOADREGS(eqfd, sp!, {r4 - r7, pc})
71                 sub     r2, r2, #4
73 acornscsi_in2:  adds    r2, r2, #2
74                 ldr     r3, [r0], #4
75                 and     r3, r3, lr
76                 strb    r3, [r1], #1
77                 mov     r3, r3, lsr #8
78                 strplb  r3, [r1], #1
79                 LOADREGS(fd, sp!, {r4 - r7, pc})
81 @ Purpose: transfer a block of data from memory to the acorn scsi card
82 @ Proto  : void acornscsi_in(unsigned int addr_start, char *buffer, int length)
83 @ Returns: nothing
85 ENTRY(__acornscsi_out)
86                 stmfd   sp!, {r4 - r6, lr}
87                 bic     r0, r0, #3
88 acornscsi_out16lp:
89                 subs    r2, r2, #16
90                 bmi     acornscsi_out8
91                 ldmia   r1!, {r4, r6, ip, lr}
92                 mov     r3, r4, lsl #16
93                 orr     r3, r3, r3, lsr #16
94                 mov     r4, r4, lsr #16
95                 orr     r4, r4, r4, lsl #16
96                 mov     r5, r6, lsl #16
97                 orr     r5, r5, r5, lsr #16
98                 mov     r6, r6, lsr #16
99                 orr     r6, r6, r6, lsl #16
100                 stmia   r0!, {r3, r4, r5, r6}
101                 mov     r3, ip, lsl #16
102                 orr     r3, r3, r3, lsr #16
103                 mov     r4, ip, lsr #16
104                 orr     r4, r4, r4, lsl #16
105                 mov     ip, lr, lsl #16
106                 orr     ip, ip, ip, lsr #16
107                 mov     lr, lr, lsr #16
108                 orr     lr, lr, lr, lsl #16
109                 stmia   r0!, {r3, r4, ip, lr}
110                 bne     acornscsi_out16lp
111                 LOADREGS(fd, sp!, {r4 - r6, pc})
113 acornscsi_out8: adds    r2, r2, #8
114                 bmi     acornscsi_out4
115                 ldmia   r1!, {r4, r6}
116                 mov     r3, r4, lsl #16
117                 orr     r3, r3, r3, lsr #16
118                 mov     r4, r4, lsr #16
119                 orr     r4, r4, r4, lsl #16
120                 mov     r5, r6, lsl #16
121                 orr     r5, r5, r5, lsr #16
122                 mov     r6, r6, lsr #16
123                 orr     r6, r6, r6, lsl #16
124                 stmia   r0!, {r3, r4, r5, r6}
125                 LOADREGS(eqfd, sp!, {r4 - r6, pc})
127                 sub     r2, r2, #8
128 acornscsi_out4: adds    r2, r2, #4
129                 bmi     acornscsi_out2
130                 ldr     r4, [r1], #4
131                 mov     r3, r4, lsl #16
132                 orr     r3, r3, r3, lsr #16
133                 mov     r4, r4, lsr #16
134                 orr     r4, r4, r4, lsl #16
135                 stmia   r0!, {r3, r4}
136                 LOADREGS(eqfd, sp!, {r4 - r6, pc})
138                 sub     r2, r2, #4
139 acornscsi_out2: adds    r2, r2, #2
140                 ldr     r3, [r1], #2
141                 strb    r3, [r0], #1
142                 mov     r3, r3, lsr #8
143                 strplb  r3, [r0], #1
144                 LOADREGS(fd, sp!, {r4 - r6, pc})