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