blob: 22171b2110a852cfd2fadc611e3220f39dbb349b [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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>
Russell Kinga09e64f2008-08-05 16:14:15 +010011#include <mach/hardware.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070012
Russell King324b93372008-04-19 15:13:45 +010013#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
Linus Torvalds1da177e2005-04-16 15:20:36 -070019@ 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
24ENTRY(__acornscsi_in)
25 stmfd sp!, {r4 - r7, lr}
26 bic r0, r0, #3
27 mov lr, #0xff
28 orr lr, lr, #0xff00
29acornscsi_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
46acornscsi_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
57acornscsi_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
66acornscsi_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
78ENTRY(__acornscsi_out)
79 stmfd sp!, {r4 - r6, lr}
80 bic r0, r0, #3
81acornscsi_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
106acornscsi_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
121acornscsi_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
132acornscsi_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