MIPS: Alchemy: change dbdma to accept physical memory addresses
[linux-2.6.git] / sound / oss / vidc_fill.S
1 /*
2  *  linux/drivers/sound/vidc_fill.S
3  *
4  *  Copyright (C) 1997 Russell King
5  *
6  * This program is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License version 2 as
8  * published by the Free Software Foundation.
9  *
10  *  Filler routines for DMA buffers
11  */
12 #include <linux/linkage.h>
13 #include <asm/assembler.h>
14 #include <mach/hardware.h>
15 #include <asm/hardware/iomd.h>
16
17                 .text
18
19 ENTRY(vidc_fill_1x8_u)
20                 mov     ip, #0xff00
21 1:              cmp     r0, r1
22                 bge     vidc_clear
23                 ldrb    r4, [r0], #1
24                 eor     r4, r4, #0x80
25                 and     r4, ip, r4, lsl #8
26                 orr     r4, r4, r4, lsl #16
27                 str     r4, [r2], #4
28                 cmp     r2, r3
29                 blt     1b
30                 mov     pc, lr
31
32 ENTRY(vidc_fill_2x8_u)
33                 mov     ip, #0xff00
34 1:              cmp     r0, r1
35                 bge     vidc_clear
36                 ldr     r4, [r0], #2
37                 and     r5, r4, ip
38                 and     r4, ip, r4, lsl #8
39                 orr     r4, r4, r5, lsl #16
40                 orr     r4, r4, r4, lsr #8
41                 str     r4, [r2], #4
42                 cmp     r2, r3
43                 blt     1b
44                 mov     pc, lr
45
46 ENTRY(vidc_fill_1x8_s)
47                 mov     ip, #0xff00
48 1:              cmp     r0, r1
49                 bge     vidc_clear
50                 ldrb    r4, [r0], #1
51                 and     r4, ip, r4, lsl #8
52                 orr     r4, r4, r4, lsl #16
53                 str     r4, [r2], #4
54                 cmp     r2, r3
55                 blt     1b
56                 mov     pc, lr
57
58 ENTRY(vidc_fill_2x8_s)
59                 mov     ip, #0xff00
60 1:              cmp     r0, r1
61                 bge     vidc_clear
62                 ldr     r4, [r0], #2
63                 and     r5, r4, ip
64                 and     r4, ip, r4, lsl #8
65                 orr     r4, r4, r5, lsl #16
66                 orr     r4, r4, r4, lsr #8
67                 str     r4, [r2], #4
68                 cmp     r2, r3
69                 blt     1b
70                 mov     pc, lr
71
72 ENTRY(vidc_fill_1x16_s)
73                 mov     ip, #0xff00
74                 orr     ip, ip, ip, lsr #8
75 1:              cmp     r0, r1
76                 bge     vidc_clear
77                 ldr     r5, [r0], #2
78                 and     r4, r5, ip
79                 orr     r4, r4, r4, lsl #16
80                 str     r4, [r2], #4
81                 cmp     r0, r1
82                 addlt   r0, r0, #2
83                 andlt   r4, r5, ip, lsl #16
84                 orrlt   r4, r4, r4, lsr #16
85                 strlt   r4, [r2], #4
86                 cmp     r2, r3
87                 blt     1b
88                 mov     pc, lr
89
90 ENTRY(vidc_fill_2x16_s)
91                 mov     ip, #0xff00
92                 orr     ip, ip, ip, lsr #8
93 1:              cmp     r0, r1
94                 bge     vidc_clear
95                 ldr     r4, [r0], #4
96                 str     r4, [r2], #4
97                 cmp     r0, r1
98                 ldrlt   r4, [r0], #4
99                 strlt   r4, [r2], #4
100                 cmp     r2, r3
101                 blt     1b
102                 mov     pc, lr
103
104 ENTRY(vidc_fill_noaudio)
105                 mov     r0, #0
106                 mov     r1, #0
107 2:              mov     r4, #0
108                 mov     r5, #0
109 1:              cmp     r2, r3
110                 stmltia r2!, {r0, r1, r4, r5}
111                 blt     1b
112                 mov     pc, lr
113
114 ENTRY(vidc_clear)
115                 mov     r0, #0
116                 mov     r1, #0
117                 tst     r2, #4
118                 str     r0, [r2], #4
119                 tst     r2, #8
120                 stmia   r2!, {r0, r1}
121                 b       2b
122
123 /*
124  * Call filler routines with:
125  *  r0 = phys address
126  *  r1 = phys end
127  *  r2 = buffer
128  * Returns:
129  *  r0 = new buffer address
130  *  r2 = new buffer finish
131  *  r4 = corrupted
132  *  r5 = corrupted
133  *  ip = corrupted
134  */
135
136 ENTRY(vidc_sound_dma_irq)
137                 stmfd   sp!, {r4 - r8, lr}
138                 ldr     r8, =dma_start
139                 ldmia   r8, {r0, r1, r2, r3, r4, r5}
140                 teq     r1, #0
141                 adreq   r4, vidc_fill_noaudio
142                 moveq   r7, #1 << 31
143                 movne   r7, #0
144                 mov     ip, #IOMD_BASE & 0xff000000
145                 orr     ip, ip, #IOMD_BASE & 0x00ff0000
146                 ldrb    r6, [ip, #IOMD_SD0ST]
147                 tst     r6, #DMA_ST_OFL                 @ Check for overrun
148                 eorne   r6, r6, #DMA_ST_AB
149                 tst     r6, #DMA_ST_AB
150                 moveq   r2, r3                          @ DMAing A, update B
151                 add     r3, r2, r5                      @ End of DMA buffer
152                 add     r1, r1, r0                      @ End of virtual DMA buffer
153                 mov     lr, pc
154                 mov     pc, r4                          @ Call fill routine (uses r4, ip)
155                 sub     r1, r1, r0                      @ Remaining length
156                 stmia   r8, {r0, r1}
157                 mov     r0, #0
158                 tst     r2, #4                          @ Round buffer up to 4 words
159                 strne   r0, [r2], #4
160                 tst     r2, #8
161                 strne   r0, [r2], #4
162                 strne   r0, [r2], #4
163                 sub     r2, r2, #16
164                 mov     r2, r2, lsl #20
165                 movs    r2, r2, lsr #20
166                 orreq   r2, r2, #1 << 30                @ Set L bit
167                 orr     r2, r2, r7
168                 ldmdb   r8, {r3, r4, r5}
169                 tst     r6, #DMA_ST_AB
170                 mov     ip, #IOMD_BASE & 0xff000000
171                 orr     ip, ip, #IOMD_BASE & 0x00ff0000
172                 streq   r4, [ip, #IOMD_SD0CURB]
173                 strne   r5, [ip, #IOMD_SD0CURA]
174                 streq   r2, [ip, #IOMD_SD0ENDB]
175                 strne   r2, [ip, #IOMD_SD0ENDA]
176                 ldr     lr, [ip, #IOMD_SD0ST]
177                 tst     lr, #DMA_ST_OFL
178                 bne     1f
179                 tst     r6, #DMA_ST_AB
180                 strne   r4, [ip, #IOMD_SD0CURB]
181                 streq   r5, [ip, #IOMD_SD0CURA]
182                 strne   r2, [ip, #IOMD_SD0ENDB]
183                 streq   r2, [ip, #IOMD_SD0ENDA]
184 1:              teq     r7, #0
185                 mov     r0, #0x10
186                 strneb  r0, [ip, #IOMD_SD0CR]
187                 ldmfd   sp!, {r4 - r8, lr}
188                 mov     r0, #1                          @ IRQ_HANDLED
189                 teq     r1, #0                          @ If we have no more
190                 movne   pc, lr
191                 teq     r3, #0
192                 movne   pc, r3                          @ Call interrupt routine
193                 mov     pc, lr
194
195                 .data
196                 .globl  dma_interrupt
197 dma_interrupt:
198                 .long   0                               @ r3
199                 .globl  dma_pbuf
200 dma_pbuf:
201                 .long   0                               @ r4
202                 .long   0                               @ r5
203                 .globl  dma_start
204 dma_start:
205                 .long   0                               @ r0
206                 .globl  dma_count
207 dma_count:
208                 .long   0                               @ r1
209                 .globl  dma_buf
210 dma_buf:
211                 .long   0                               @ r2
212                 .long   0                               @ r3
213                 .globl  vidc_filler
214 vidc_filler:
215                 .long   vidc_fill_noaudio               @ r4
216                 .globl  dma_bufsize
217 dma_bufsize:
218                 .long   0x1000                          @ r5