1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Driver for Sound Core PDAudioCF soundcard
4 *
5 * Copyright (c) 2003 by Jaroslav Kysela <perex@perex.cz>
6 */
7
8 #include <sound/core.h>
9 #include "pdaudiocf.h"
10 #include <sound/initval.h>
11 #include <asm/irq_regs.h>
12
13 /*
14 *
15 */
pdacf_interrupt(int irq,void * dev)16 irqreturn_t pdacf_interrupt(int irq, void *dev)
17 {
18 struct snd_pdacf *chip = dev;
19 unsigned short stat;
20 bool wake_thread = false;
21
22 if ((chip->chip_status & (PDAUDIOCF_STAT_IS_STALE|
23 PDAUDIOCF_STAT_IS_CONFIGURED|
24 PDAUDIOCF_STAT_IS_SUSPENDED)) != PDAUDIOCF_STAT_IS_CONFIGURED)
25 return IRQ_HANDLED; /* IRQ_NONE here? */
26
27 stat = inw(chip->port + PDAUDIOCF_REG_ISR);
28 if (stat & (PDAUDIOCF_IRQLVL|PDAUDIOCF_IRQOVR)) {
29 if (stat & PDAUDIOCF_IRQOVR) /* should never happen */
30 snd_printk(KERN_ERR "PDAUDIOCF SRAM buffer overrun detected!\n");
31 if (chip->pcm_substream)
32 wake_thread = true;
33 if (!(stat & PDAUDIOCF_IRQAKM))
34 stat |= PDAUDIOCF_IRQAKM; /* check rate */
35 }
36 if (get_irq_regs() != NULL)
37 snd_ak4117_check_rate_and_errors(chip->ak4117, 0);
38 return wake_thread ? IRQ_WAKE_THREAD : IRQ_HANDLED;
39 }
40
pdacf_transfer_mono16(u16 * dst,u16 xor,unsigned int size,unsigned long rdp_port)41 static inline void pdacf_transfer_mono16(u16 *dst, u16 xor, unsigned int size, unsigned long rdp_port)
42 {
43 while (size-- > 0) {
44 *dst++ = inw(rdp_port) ^ xor;
45 inw(rdp_port);
46 }
47 }
48
pdacf_transfer_mono32(u32 * dst,u32 xor,unsigned int size,unsigned long rdp_port)49 static inline void pdacf_transfer_mono32(u32 *dst, u32 xor, unsigned int size, unsigned long rdp_port)
50 {
51 register u16 val1, val2;
52
53 while (size-- > 0) {
54 val1 = inw(rdp_port);
55 val2 = inw(rdp_port);
56 inw(rdp_port);
57 *dst++ = ((((u32)val2 & 0xff) << 24) | ((u32)val1 << 8)) ^ xor;
58 }
59 }
60
pdacf_transfer_stereo16(u16 * dst,u16 xor,unsigned int size,unsigned long rdp_port)61 static inline void pdacf_transfer_stereo16(u16 *dst, u16 xor, unsigned int size, unsigned long rdp_port)
62 {
63 while (size-- > 0) {
64 *dst++ = inw(rdp_port) ^ xor;
65 *dst++ = inw(rdp_port) ^ xor;
66 }
67 }
68
pdacf_transfer_stereo32(u32 * dst,u32 xor,unsigned int size,unsigned long rdp_port)69 static inline void pdacf_transfer_stereo32(u32 *dst, u32 xor, unsigned int size, unsigned long rdp_port)
70 {
71 register u16 val1, val2, val3;
72
73 while (size-- > 0) {
74 val1 = inw(rdp_port);
75 val2 = inw(rdp_port);
76 val3 = inw(rdp_port);
77 *dst++ = ((((u32)val2 & 0xff) << 24) | ((u32)val1 << 8)) ^ xor;
78 *dst++ = (((u32)val3 << 16) | (val2 & 0xff00)) ^ xor;
79 }
80 }
81
pdacf_transfer_mono16sw(u16 * dst,u16 xor,unsigned int size,unsigned long rdp_port)82 static inline void pdacf_transfer_mono16sw(u16 *dst, u16 xor, unsigned int size, unsigned long rdp_port)
83 {
84 while (size-- > 0) {
85 *dst++ = swab16(inw(rdp_port) ^ xor);
86 inw(rdp_port);
87 }
88 }
89
pdacf_transfer_mono32sw(u32 * dst,u32 xor,unsigned int size,unsigned long rdp_port)90 static inline void pdacf_transfer_mono32sw(u32 *dst, u32 xor, unsigned int size, unsigned long rdp_port)
91 {
92 register u16 val1, val2;
93
94 while (size-- > 0) {
95 val1 = inw(rdp_port);
96 val2 = inw(rdp_port);
97 inw(rdp_port);
98 *dst++ = swab32((((val2 & 0xff) << 24) | ((u32)val1 << 8)) ^ xor);
99 }
100 }
101
pdacf_transfer_stereo16sw(u16 * dst,u16 xor,unsigned int size,unsigned long rdp_port)102 static inline void pdacf_transfer_stereo16sw(u16 *dst, u16 xor, unsigned int size, unsigned long rdp_port)
103 {
104 while (size-- > 0) {
105 *dst++ = swab16(inw(rdp_port) ^ xor);
106 *dst++ = swab16(inw(rdp_port) ^ xor);
107 }
108 }
109
pdacf_transfer_stereo32sw(u32 * dst,u32 xor,unsigned int size,unsigned long rdp_port)110 static inline void pdacf_transfer_stereo32sw(u32 *dst, u32 xor, unsigned int size, unsigned long rdp_port)
111 {
112 register u16 val1, val2, val3;
113
114 while (size-- > 0) {
115 val1 = inw(rdp_port);
116 val2 = inw(rdp_port);
117 val3 = inw(rdp_port);
118 *dst++ = swab32((((val2 & 0xff) << 24) | ((u32)val1 << 8)) ^ xor);
119 *dst++ = swab32((((u32)val3 << 16) | (val2 & 0xff00)) ^ xor);
120 }
121 }
122
pdacf_transfer_mono24le(u8 * dst,u16 xor,unsigned int size,unsigned long rdp_port)123 static inline void pdacf_transfer_mono24le(u8 *dst, u16 xor, unsigned int size, unsigned long rdp_port)
124 {
125 register u16 val1, val2;
126 register u32 xval1;
127
128 while (size-- > 0) {
129 val1 = inw(rdp_port);
130 val2 = inw(rdp_port);
131 inw(rdp_port);
132 xval1 = (((val2 & 0xff) << 8) | (val1 << 16)) ^ xor;
133 *dst++ = (u8)(xval1 >> 8);
134 *dst++ = (u8)(xval1 >> 16);
135 *dst++ = (u8)(xval1 >> 24);
136 }
137 }
138
pdacf_transfer_mono24be(u8 * dst,u16 xor,unsigned int size,unsigned long rdp_port)139 static inline void pdacf_transfer_mono24be(u8 *dst, u16 xor, unsigned int size, unsigned long rdp_port)
140 {
141 register u16 val1, val2;
142 register u32 xval1;
143
144 while (size-- > 0) {
145 val1 = inw(rdp_port);
146 val2 = inw(rdp_port);
147 inw(rdp_port);
148 xval1 = (((val2 & 0xff) << 8) | (val1 << 16)) ^ xor;
149 *dst++ = (u8)(xval1 >> 24);
150 *dst++ = (u8)(xval1 >> 16);
151 *dst++ = (u8)(xval1 >> 8);
152 }
153 }
154
pdacf_transfer_stereo24le(u8 * dst,u32 xor,unsigned int size,unsigned long rdp_port)155 static inline void pdacf_transfer_stereo24le(u8 *dst, u32 xor, unsigned int size, unsigned long rdp_port)
156 {
157 register u16 val1, val2, val3;
158 register u32 xval1, xval2;
159
160 while (size-- > 0) {
161 val1 = inw(rdp_port);
162 val2 = inw(rdp_port);
163 val3 = inw(rdp_port);
164 xval1 = ((((u32)val2 & 0xff) << 24) | ((u32)val1 << 8)) ^ xor;
165 xval2 = (((u32)val3 << 16) | (val2 & 0xff00)) ^ xor;
166 *dst++ = (u8)(xval1 >> 8);
167 *dst++ = (u8)(xval1 >> 16);
168 *dst++ = (u8)(xval1 >> 24);
169 *dst++ = (u8)(xval2 >> 8);
170 *dst++ = (u8)(xval2 >> 16);
171 *dst++ = (u8)(xval2 >> 24);
172 }
173 }
174
pdacf_transfer_stereo24be(u8 * dst,u32 xor,unsigned int size,unsigned long rdp_port)175 static inline void pdacf_transfer_stereo24be(u8 *dst, u32 xor, unsigned int size, unsigned long rdp_port)
176 {
177 register u16 val1, val2, val3;
178 register u32 xval1, xval2;
179
180 while (size-- > 0) {
181 val1 = inw(rdp_port);
182 val2 = inw(rdp_port);
183 val3 = inw(rdp_port);
184 xval1 = ((((u32)val2 & 0xff) << 24) | ((u32)val1 << 8)) ^ xor;
185 xval2 = (((u32)val3 << 16) | (val2 & 0xff00)) ^ xor;
186 *dst++ = (u8)(xval1 >> 24);
187 *dst++ = (u8)(xval1 >> 16);
188 *dst++ = (u8)(xval1 >> 8);
189 *dst++ = (u8)(xval2 >> 24);
190 *dst++ = (u8)(xval2 >> 16);
191 *dst++ = (u8)(xval2 >> 8);
192 }
193 }
194
pdacf_transfer(struct snd_pdacf * chip,unsigned int size,unsigned int off)195 static void pdacf_transfer(struct snd_pdacf *chip, unsigned int size, unsigned int off)
196 {
197 unsigned long rdp_port = chip->port + PDAUDIOCF_REG_MD;
198 unsigned int xor = chip->pcm_xor;
199
200 if (chip->pcm_sample == 3) {
201 if (chip->pcm_little) {
202 if (chip->pcm_channels == 1) {
203 pdacf_transfer_mono24le((char *)chip->pcm_area + (off * 3), xor, size, rdp_port);
204 } else {
205 pdacf_transfer_stereo24le((char *)chip->pcm_area + (off * 6), xor, size, rdp_port);
206 }
207 } else {
208 if (chip->pcm_channels == 1) {
209 pdacf_transfer_mono24be((char *)chip->pcm_area + (off * 3), xor, size, rdp_port);
210 } else {
211 pdacf_transfer_stereo24be((char *)chip->pcm_area + (off * 6), xor, size, rdp_port);
212 }
213 }
214 return;
215 }
216 if (chip->pcm_swab == 0) {
217 if (chip->pcm_channels == 1) {
218 if (chip->pcm_frame == 2) {
219 pdacf_transfer_mono16((u16 *)chip->pcm_area + off, xor, size, rdp_port);
220 } else {
221 pdacf_transfer_mono32((u32 *)chip->pcm_area + off, xor, size, rdp_port);
222 }
223 } else {
224 if (chip->pcm_frame == 2) {
225 pdacf_transfer_stereo16((u16 *)chip->pcm_area + (off * 2), xor, size, rdp_port);
226 } else {
227 pdacf_transfer_stereo32((u32 *)chip->pcm_area + (off * 2), xor, size, rdp_port);
228 }
229 }
230 } else {
231 if (chip->pcm_channels == 1) {
232 if (chip->pcm_frame == 2) {
233 pdacf_transfer_mono16sw((u16 *)chip->pcm_area + off, xor, size, rdp_port);
234 } else {
235 pdacf_transfer_mono32sw((u32 *)chip->pcm_area + off, xor, size, rdp_port);
236 }
237 } else {
238 if (chip->pcm_frame == 2) {
239 pdacf_transfer_stereo16sw((u16 *)chip->pcm_area + (off * 2), xor, size, rdp_port);
240 } else {
241 pdacf_transfer_stereo32sw((u32 *)chip->pcm_area + (off * 2), xor, size, rdp_port);
242 }
243 }
244 }
245 }
246
pdacf_threaded_irq(int irq,void * dev)247 irqreturn_t pdacf_threaded_irq(int irq, void *dev)
248 {
249 struct snd_pdacf *chip = dev;
250 int size, off, cont, rdp, wdp;
251
252 if ((chip->chip_status & (PDAUDIOCF_STAT_IS_STALE|PDAUDIOCF_STAT_IS_CONFIGURED)) != PDAUDIOCF_STAT_IS_CONFIGURED)
253 return IRQ_HANDLED;
254
255 if (chip->pcm_substream == NULL || chip->pcm_substream->runtime == NULL || !snd_pcm_running(chip->pcm_substream))
256 return IRQ_HANDLED;
257
258 rdp = inw(chip->port + PDAUDIOCF_REG_RDP);
259 wdp = inw(chip->port + PDAUDIOCF_REG_WDP);
260 /* printk(KERN_DEBUG "TASKLET: rdp = %x, wdp = %x\n", rdp, wdp); */
261 size = wdp - rdp;
262 if (size < 0)
263 size += 0x10000;
264 if (size == 0)
265 size = 0x10000;
266 size /= chip->pcm_frame;
267 if (size > 64)
268 size -= 32;
269
270 #if 0
271 chip->pcm_hwptr += size;
272 chip->pcm_hwptr %= chip->pcm_size;
273 chip->pcm_tdone += size;
274 if (chip->pcm_frame == 2) {
275 unsigned long rdp_port = chip->port + PDAUDIOCF_REG_MD;
276 while (size-- > 0) {
277 inw(rdp_port);
278 inw(rdp_port);
279 }
280 } else {
281 unsigned long rdp_port = chip->port + PDAUDIOCF_REG_MD;
282 while (size-- > 0) {
283 inw(rdp_port);
284 inw(rdp_port);
285 inw(rdp_port);
286 }
287 }
288 #else
289 off = chip->pcm_hwptr + chip->pcm_tdone;
290 off %= chip->pcm_size;
291 chip->pcm_tdone += size;
292 while (size > 0) {
293 cont = chip->pcm_size - off;
294 if (cont > size)
295 cont = size;
296 pdacf_transfer(chip, cont, off);
297 off += cont;
298 off %= chip->pcm_size;
299 size -= cont;
300 }
301 #endif
302 mutex_lock(&chip->reg_lock);
303 while (chip->pcm_tdone >= chip->pcm_period) {
304 chip->pcm_hwptr += chip->pcm_period;
305 chip->pcm_hwptr %= chip->pcm_size;
306 chip->pcm_tdone -= chip->pcm_period;
307 mutex_unlock(&chip->reg_lock);
308 snd_pcm_period_elapsed(chip->pcm_substream);
309 mutex_lock(&chip->reg_lock);
310 }
311 mutex_unlock(&chip->reg_lock);
312 return IRQ_HANDLED;
313 }
314