Commit | Line | Data |
---|---|---|
1da177e4 LT |
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> | |
9 | ||
10 | #include <asm/assembler.h> | |
a09e64fb | 11 | #include <mach/hardware.h> |
1da177e4 | 12 | |
324b9337 RK |
13 | #if defined(__APCS_32__) |
14 | #define LOADREGS(t,r,l...) ldm##t r, l | |
15 | #elif defined(__APCS_26__) | |
16 | #define LOADREGS(t,r,l...) ldm##t r, l##^ | |
17 | #endif | |
18 | ||
1da177e4 LT |
19 | @ Purpose: transfer a block of data from the acorn scsi card to memory |
20 | @ Proto : void acornscsi_in(unsigned int addr_start, char *buffer, int length) | |
21 | @ Returns: nothing | |
22 | ||
23 | .align | |
24 | ENTRY(__acornscsi_in) | |
25 | stmfd sp!, {r4 - r7, lr} | |
26 | bic r0, r0, #3 | |
27 | mov lr, #0xff | |
28 | orr lr, lr, #0xff00 | |
29 | acornscsi_in16lp: | |
30 | subs r2, r2, #16 | |
31 | bmi acornscsi_in8 | |
32 | ldmia r0!, {r3, r4, r5, r6} | |
33 | and r3, r3, lr | |
34 | orr r3, r3, r4, lsl #16 | |
35 | and r4, r5, lr | |
36 | orr r4, r4, r6, lsl #16 | |
37 | ldmia r0!, {r5, r6, r7, ip} | |
38 | and r5, r5, lr | |
39 | orr r5, r5, r6, lsl #16 | |
40 | and r6, r7, lr | |
41 | orr r6, r6, ip, lsl #16 | |
42 | stmia r1!, {r3 - r6} | |
43 | bne acornscsi_in16lp | |
44 | LOADREGS(fd, sp!, {r4 - r7, pc}) | |
45 | ||
46 | acornscsi_in8: adds r2, r2, #8 | |
47 | bmi acornscsi_in4 | |
48 | ldmia r0!, {r3, r4, r5, r6} | |
49 | and r3, r3, lr | |
50 | orr r3, r3, r4, lsl #16 | |
51 | and r4, r5, lr | |
52 | orr r4, r4, r6, lsl #16 | |
53 | stmia r1!, {r3 - r4} | |
54 | LOADREGS(eqfd, sp!, {r4 - r7, pc}) | |
55 | sub r2, r2, #8 | |
56 | ||
57 | acornscsi_in4: adds r2, r2, #4 | |
58 | bmi acornscsi_in2 | |
59 | ldmia r0!, {r3, r4} | |
60 | and r3, r3, lr | |
61 | orr r3, r3, r4, lsl #16 | |
62 | str r3, [r1], #4 | |
63 | LOADREGS(eqfd, sp!, {r4 - r7, pc}) | |
64 | sub r2, r2, #4 | |
65 | ||
66 | acornscsi_in2: adds r2, r2, #2 | |
67 | ldr r3, [r0], #4 | |
68 | and r3, r3, lr | |
69 | strb r3, [r1], #1 | |
70 | mov r3, r3, lsr #8 | |
71 | strplb r3, [r1], #1 | |
72 | LOADREGS(fd, sp!, {r4 - r7, pc}) | |
73 | ||
74 | @ Purpose: transfer a block of data from memory to the acorn scsi card | |
75 | @ Proto : void acornscsi_in(unsigned int addr_start, char *buffer, int length) | |
76 | @ Returns: nothing | |
77 | ||
78 | ENTRY(__acornscsi_out) | |
79 | stmfd sp!, {r4 - r6, lr} | |
80 | bic r0, r0, #3 | |
81 | acornscsi_out16lp: | |
82 | subs r2, r2, #16 | |
83 | bmi acornscsi_out8 | |
84 | ldmia r1!, {r4, r6, ip, lr} | |
85 | mov r3, r4, lsl #16 | |
86 | orr r3, r3, r3, lsr #16 | |
87 | mov r4, r4, lsr #16 | |
88 | orr r4, r4, r4, lsl #16 | |
89 | mov r5, r6, lsl #16 | |
90 | orr r5, r5, r5, lsr #16 | |
91 | mov r6, r6, lsr #16 | |
92 | orr r6, r6, r6, lsl #16 | |
93 | stmia r0!, {r3, r4, r5, r6} | |
94 | mov r3, ip, lsl #16 | |
95 | orr r3, r3, r3, lsr #16 | |
96 | mov r4, ip, lsr #16 | |
97 | orr r4, r4, r4, lsl #16 | |
98 | mov ip, lr, lsl #16 | |
99 | orr ip, ip, ip, lsr #16 | |
100 | mov lr, lr, lsr #16 | |
101 | orr lr, lr, lr, lsl #16 | |
102 | stmia r0!, {r3, r4, ip, lr} | |
103 | bne acornscsi_out16lp | |
104 | LOADREGS(fd, sp!, {r4 - r6, pc}) | |
105 | ||
106 | acornscsi_out8: adds r2, r2, #8 | |
107 | bmi acornscsi_out4 | |
108 | ldmia r1!, {r4, r6} | |
109 | mov r3, r4, lsl #16 | |
110 | orr r3, r3, r3, lsr #16 | |
111 | mov r4, r4, lsr #16 | |
112 | orr r4, r4, r4, lsl #16 | |
113 | mov r5, r6, lsl #16 | |
114 | orr r5, r5, r5, lsr #16 | |
115 | mov r6, r6, lsr #16 | |
116 | orr r6, r6, r6, lsl #16 | |
117 | stmia r0!, {r3, r4, r5, r6} | |
118 | LOADREGS(eqfd, sp!, {r4 - r6, pc}) | |
119 | ||
120 | sub r2, r2, #8 | |
121 | acornscsi_out4: adds r2, r2, #4 | |
122 | bmi acornscsi_out2 | |
123 | ldr r4, [r1], #4 | |
124 | mov r3, r4, lsl #16 | |
125 | orr r3, r3, r3, lsr #16 | |
126 | mov r4, r4, lsr #16 | |
127 | orr r4, r4, r4, lsl #16 | |
128 | stmia r0!, {r3, r4} | |
129 | LOADREGS(eqfd, sp!, {r4 - r6, pc}) | |
130 | ||
131 | sub r2, r2, #4 | |
132 | acornscsi_out2: adds r2, r2, #2 | |
133 | ldr r3, [r1], #2 | |
134 | strb r3, [r0], #1 | |
135 | mov r3, r3, lsr #8 | |
136 | strplb r3, [r0], #1 | |
137 | LOADREGS(fd, sp!, {r4 - r6, pc}) | |
138 |