xref: /openbmc/linux/sound/sparc/amd7930.c (revision 7e9f2839)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Driver for AMD7930 sound chips found on Sparcs.
4  * Copyright (C) 2002, 2008 David S. Miller <davem@davemloft.net>
5  *
6  * Based entirely upon drivers/sbus/audio/amd7930.c which is:
7  * Copyright (C) 1996,1997 Thomas K. Dyas (tdyas@eden.rutgers.edu)
8  *
9  * --- Notes from Thomas's original driver ---
10  * This is the lowlevel driver for the AMD7930 audio chip found on all
11  * sun4c machines and some sun4m machines.
12  *
13  * The amd7930 is actually an ISDN chip which has a very simple
14  * integrated audio encoder/decoder. When Sun decided on what chip to
15  * use for audio, they had the brilliant idea of using the amd7930 and
16  * only connecting the audio encoder/decoder pins.
17  *
18  * Thanks to the AMD engineer who was able to get us the AMD79C30
19  * databook which has all the programming information and gain tables.
20  *
21  * Advanced Micro Devices' Am79C30A is an ISDN/audio chip used in the
22  * SparcStation 1+.  The chip provides microphone and speaker interfaces
23  * which provide mono-channel audio at 8K samples per second via either
24  * 8-bit A-law or 8-bit mu-law encoding.  Also, the chip features an
25  * ISDN BRI Line Interface Unit (LIU), I.430 S/T physical interface,
26  * which performs basic D channel LAPD processing and provides raw
27  * B channel data.  The digital audio channel, the two ISDN B channels,
28  * and two 64 Kbps channels to the microprocessor are all interconnected
29  * via a multiplexer.
30  * --- End of notes from Thoamas's original driver ---
31  */
32 
33 #include <linux/module.h>
34 #include <linux/kernel.h>
35 #include <linux/slab.h>
36 #include <linux/init.h>
37 #include <linux/interrupt.h>
38 #include <linux/moduleparam.h>
39 #include <linux/of.h>
40 #include <linux/platform_device.h>
41 #include <linux/io.h>
42 
43 #include <sound/core.h>
44 #include <sound/pcm.h>
45 #include <sound/info.h>
46 #include <sound/control.h>
47 #include <sound/initval.h>
48 
49 #include <asm/irq.h>
50 
51 static int index[SNDRV_CARDS] = SNDRV_DEFAULT_IDX;	/* Index 0-MAX */
52 static char *id[SNDRV_CARDS] = SNDRV_DEFAULT_STR;	/* ID for this card */
53 static bool enable[SNDRV_CARDS] = SNDRV_DEFAULT_ENABLE_PNP;	/* Enable this card */
54 
55 module_param_array(index, int, NULL, 0444);
56 MODULE_PARM_DESC(index, "Index value for Sun AMD7930 soundcard.");
57 module_param_array(id, charp, NULL, 0444);
58 MODULE_PARM_DESC(id, "ID string for Sun AMD7930 soundcard.");
59 module_param_array(enable, bool, NULL, 0444);
60 MODULE_PARM_DESC(enable, "Enable Sun AMD7930 soundcard.");
61 MODULE_AUTHOR("Thomas K. Dyas and David S. Miller");
62 MODULE_DESCRIPTION("Sun AMD7930");
63 MODULE_LICENSE("GPL");
64 
65 /* Device register layout.  */
66 
67 /* Register interface presented to the CPU by the amd7930. */
68 #define AMD7930_CR	0x00UL		/* Command Register (W) */
69 #define AMD7930_IR	AMD7930_CR	/* Interrupt Register (R) */
70 #define AMD7930_DR	0x01UL		/* Data Register (R/W) */
71 #define AMD7930_DSR1	0x02UL		/* D-channel Status Register 1 (R) */
72 #define AMD7930_DER	0x03UL		/* D-channel Error Register (R) */
73 #define AMD7930_DCTB	0x04UL		/* D-channel Transmit Buffer (W) */
74 #define AMD7930_DCRB	AMD7930_DCTB	/* D-channel Receive Buffer (R) */
75 #define AMD7930_BBTB	0x05UL		/* Bb-channel Transmit Buffer (W) */
76 #define AMD7930_BBRB	AMD7930_BBTB	/* Bb-channel Receive Buffer (R) */
77 #define AMD7930_BCTB	0x06UL		/* Bc-channel Transmit Buffer (W) */
78 #define AMD7930_BCRB	AMD7930_BCTB	/* Bc-channel Receive Buffer (R) */
79 #define AMD7930_DSR2	0x07UL		/* D-channel Status Register 2 (R) */
80 
81 /* Indirect registers in the Main Audio Processor. */
82 struct amd7930_map {
83 	__u16	x[8];
84 	__u16	r[8];
85 	__u16	gx;
86 	__u16	gr;
87 	__u16	ger;
88 	__u16	stgr;
89 	__u16	ftgr;
90 	__u16	atgr;
91 	__u8	mmr1;
92 	__u8	mmr2;
93 };
94 
95 /* After an amd7930 interrupt, reading the Interrupt Register (ir)
96  * clears the interrupt and returns a bitmask indicating which
97  * interrupt source(s) require service.
98  */
99 
100 #define AMR_IR_DTTHRSH			0x01 /* D-channel xmit threshold */
101 #define AMR_IR_DRTHRSH			0x02 /* D-channel recv threshold */
102 #define AMR_IR_DSRI			0x04 /* D-channel packet status */
103 #define AMR_IR_DERI			0x08 /* D-channel error */
104 #define AMR_IR_BBUF			0x10 /* B-channel data xfer */
105 #define AMR_IR_LSRI			0x20 /* LIU status */
106 #define AMR_IR_DSR2I			0x40 /* D-channel buffer status */
107 #define AMR_IR_MLTFRMI			0x80 /* multiframe or PP */
108 
109 /* The amd7930 has "indirect registers" which are accessed by writing
110  * the register number into the Command Register and then reading or
111  * writing values from the Data Register as appropriate. We define the
112  * AMR_* macros to be the indirect register numbers and AM_* macros to
113  * be bits in whatever register is referred to.
114  */
115 
116 /* Initialization */
117 #define	AMR_INIT			0x21
118 #define		AM_INIT_ACTIVE			0x01
119 #define		AM_INIT_DATAONLY		0x02
120 #define		AM_INIT_POWERDOWN		0x03
121 #define		AM_INIT_DISABLE_INTS		0x04
122 #define AMR_INIT2			0x20
123 #define		AM_INIT2_ENABLE_POWERDOWN	0x20
124 #define		AM_INIT2_ENABLE_MULTIFRAME	0x10
125 
126 /* Line Interface Unit */
127 #define	AMR_LIU_LSR			0xA1
128 #define		AM_LIU_LSR_STATE		0x07
129 #define		AM_LIU_LSR_F3			0x08
130 #define		AM_LIU_LSR_F7			0x10
131 #define		AM_LIU_LSR_F8			0x20
132 #define		AM_LIU_LSR_HSW			0x40
133 #define		AM_LIU_LSR_HSW_CHG		0x80
134 #define	AMR_LIU_LPR			0xA2
135 #define	AMR_LIU_LMR1			0xA3
136 #define		AM_LIU_LMR1_B1_ENABL		0x01
137 #define		AM_LIU_LMR1_B2_ENABL		0x02
138 #define		AM_LIU_LMR1_F_DISABL		0x04
139 #define		AM_LIU_LMR1_FA_DISABL		0x08
140 #define		AM_LIU_LMR1_REQ_ACTIV		0x10
141 #define		AM_LIU_LMR1_F8_F3		0x20
142 #define		AM_LIU_LMR1_LIU_ENABL		0x40
143 #define	AMR_LIU_LMR2			0xA4
144 #define		AM_LIU_LMR2_DECHO		0x01
145 #define		AM_LIU_LMR2_DLOOP		0x02
146 #define		AM_LIU_LMR2_DBACKOFF		0x04
147 #define		AM_LIU_LMR2_EN_F3_INT		0x08
148 #define		AM_LIU_LMR2_EN_F8_INT		0x10
149 #define		AM_LIU_LMR2_EN_HSW_INT		0x20
150 #define		AM_LIU_LMR2_EN_F7_INT		0x40
151 #define	AMR_LIU_2_4			0xA5
152 #define	AMR_LIU_MF			0xA6
153 #define	AMR_LIU_MFSB			0xA7
154 #define	AMR_LIU_MFQB			0xA8
155 
156 /* Multiplexor */
157 #define	AMR_MUX_MCR1			0x41
158 #define	AMR_MUX_MCR2			0x42
159 #define	AMR_MUX_MCR3			0x43
160 #define		AM_MUX_CHANNEL_B1		0x01
161 #define		AM_MUX_CHANNEL_B2		0x02
162 #define		AM_MUX_CHANNEL_Ba		0x03
163 #define		AM_MUX_CHANNEL_Bb		0x04
164 #define		AM_MUX_CHANNEL_Bc		0x05
165 #define		AM_MUX_CHANNEL_Bd		0x06
166 #define		AM_MUX_CHANNEL_Be		0x07
167 #define		AM_MUX_CHANNEL_Bf		0x08
168 #define	AMR_MUX_MCR4			0x44
169 #define		AM_MUX_MCR4_ENABLE_INTS		0x08
170 #define		AM_MUX_MCR4_REVERSE_Bb		0x10
171 #define		AM_MUX_MCR4_REVERSE_Bc		0x20
172 #define	AMR_MUX_1_4			0x45
173 
174 /* Main Audio Processor */
175 #define	AMR_MAP_X			0x61
176 #define	AMR_MAP_R			0x62
177 #define	AMR_MAP_GX			0x63
178 #define	AMR_MAP_GR			0x64
179 #define	AMR_MAP_GER			0x65
180 #define	AMR_MAP_STGR			0x66
181 #define	AMR_MAP_FTGR_1_2		0x67
182 #define	AMR_MAP_ATGR_1_2		0x68
183 #define	AMR_MAP_MMR1			0x69
184 #define		AM_MAP_MMR1_ALAW		0x01
185 #define		AM_MAP_MMR1_GX			0x02
186 #define		AM_MAP_MMR1_GR			0x04
187 #define		AM_MAP_MMR1_GER			0x08
188 #define		AM_MAP_MMR1_X			0x10
189 #define		AM_MAP_MMR1_R			0x20
190 #define		AM_MAP_MMR1_STG			0x40
191 #define		AM_MAP_MMR1_LOOPBACK		0x80
192 #define	AMR_MAP_MMR2			0x6A
193 #define		AM_MAP_MMR2_AINB		0x01
194 #define		AM_MAP_MMR2_LS			0x02
195 #define		AM_MAP_MMR2_ENABLE_DTMF		0x04
196 #define		AM_MAP_MMR2_ENABLE_TONEGEN	0x08
197 #define		AM_MAP_MMR2_ENABLE_TONERING	0x10
198 #define		AM_MAP_MMR2_DISABLE_HIGHPASS	0x20
199 #define		AM_MAP_MMR2_DISABLE_AUTOZERO	0x40
200 #define	AMR_MAP_1_10			0x6B
201 #define	AMR_MAP_MMR3			0x6C
202 #define	AMR_MAP_STRA			0x6D
203 #define	AMR_MAP_STRF			0x6E
204 #define	AMR_MAP_PEAKX			0x70
205 #define	AMR_MAP_PEAKR			0x71
206 #define	AMR_MAP_15_16			0x72
207 
208 /* Data Link Controller */
209 #define	AMR_DLC_FRAR_1_2_3		0x81
210 #define	AMR_DLC_SRAR_1_2_3		0x82
211 #define	AMR_DLC_TAR			0x83
212 #define	AMR_DLC_DRLR			0x84
213 #define	AMR_DLC_DTCR			0x85
214 #define	AMR_DLC_DMR1			0x86
215 #define		AMR_DLC_DMR1_DTTHRSH_INT	0x01
216 #define		AMR_DLC_DMR1_DRTHRSH_INT	0x02
217 #define		AMR_DLC_DMR1_TAR_ENABL		0x04
218 #define		AMR_DLC_DMR1_EORP_INT		0x08
219 #define		AMR_DLC_DMR1_EN_ADDR1		0x10
220 #define		AMR_DLC_DMR1_EN_ADDR2		0x20
221 #define		AMR_DLC_DMR1_EN_ADDR3		0x40
222 #define		AMR_DLC_DMR1_EN_ADDR4		0x80
223 #define		AMR_DLC_DMR1_EN_ADDRS		0xf0
224 #define	AMR_DLC_DMR2			0x87
225 #define		AMR_DLC_DMR2_RABRT_INT		0x01
226 #define		AMR_DLC_DMR2_RESID_INT		0x02
227 #define		AMR_DLC_DMR2_COLL_INT		0x04
228 #define		AMR_DLC_DMR2_FCS_INT		0x08
229 #define		AMR_DLC_DMR2_OVFL_INT		0x10
230 #define		AMR_DLC_DMR2_UNFL_INT		0x20
231 #define		AMR_DLC_DMR2_OVRN_INT		0x40
232 #define		AMR_DLC_DMR2_UNRN_INT		0x80
233 #define	AMR_DLC_1_7			0x88
234 #define	AMR_DLC_DRCR			0x89
235 #define	AMR_DLC_RNGR1			0x8A
236 #define	AMR_DLC_RNGR2			0x8B
237 #define	AMR_DLC_FRAR4			0x8C
238 #define	AMR_DLC_SRAR4			0x8D
239 #define	AMR_DLC_DMR3			0x8E
240 #define		AMR_DLC_DMR3_VA_INT		0x01
241 #define		AMR_DLC_DMR3_EOTP_INT		0x02
242 #define		AMR_DLC_DMR3_LBRP_INT		0x04
243 #define		AMR_DLC_DMR3_RBA_INT		0x08
244 #define		AMR_DLC_DMR3_LBT_INT		0x10
245 #define		AMR_DLC_DMR3_TBE_INT		0x20
246 #define		AMR_DLC_DMR3_RPLOST_INT		0x40
247 #define		AMR_DLC_DMR3_KEEP_FCS		0x80
248 #define	AMR_DLC_DMR4			0x8F
249 #define		AMR_DLC_DMR4_RCV_1		0x00
250 #define		AMR_DLC_DMR4_RCV_2		0x01
251 #define		AMR_DLC_DMR4_RCV_4		0x02
252 #define		AMR_DLC_DMR4_RCV_8		0x03
253 #define		AMR_DLC_DMR4_RCV_16		0x01
254 #define		AMR_DLC_DMR4_RCV_24		0x02
255 #define		AMR_DLC_DMR4_RCV_30		0x03
256 #define		AMR_DLC_DMR4_XMT_1		0x00
257 #define		AMR_DLC_DMR4_XMT_2		0x04
258 #define		AMR_DLC_DMR4_XMT_4		0x08
259 #define		AMR_DLC_DMR4_XMT_8		0x0c
260 #define		AMR_DLC_DMR4_XMT_10		0x08
261 #define		AMR_DLC_DMR4_XMT_14		0x0c
262 #define		AMR_DLC_DMR4_IDLE_MARK		0x00
263 #define		AMR_DLC_DMR4_IDLE_FLAG		0x10
264 #define		AMR_DLC_DMR4_ADDR_BOTH		0x00
265 #define		AMR_DLC_DMR4_ADDR_1ST		0x20
266 #define		AMR_DLC_DMR4_ADDR_2ND		0xa0
267 #define		AMR_DLC_DMR4_CR_ENABLE		0x40
268 #define	AMR_DLC_12_15			0x90
269 #define	AMR_DLC_ASR			0x91
270 #define	AMR_DLC_EFCR			0x92
271 #define		AMR_DLC_EFCR_EXTEND_FIFO	0x01
272 #define		AMR_DLC_EFCR_SEC_PKT_INT	0x02
273 
274 #define AMR_DSR1_VADDR			0x01
275 #define AMR_DSR1_EORP			0x02
276 #define AMR_DSR1_PKT_IP			0x04
277 #define AMR_DSR1_DECHO_ON		0x08
278 #define AMR_DSR1_DLOOP_ON		0x10
279 #define AMR_DSR1_DBACK_OFF		0x20
280 #define AMR_DSR1_EOTP			0x40
281 #define AMR_DSR1_CXMT_ABRT		0x80
282 
283 #define AMR_DSR2_LBRP			0x01
284 #define AMR_DSR2_RBA			0x02
285 #define AMR_DSR2_RPLOST			0x04
286 #define AMR_DSR2_LAST_BYTE		0x08
287 #define AMR_DSR2_TBE			0x10
288 #define AMR_DSR2_MARK_IDLE		0x20
289 #define AMR_DSR2_FLAG_IDLE		0x40
290 #define AMR_DSR2_SECOND_PKT		0x80
291 
292 #define AMR_DER_RABRT			0x01
293 #define AMR_DER_RFRAME			0x02
294 #define AMR_DER_COLLISION		0x04
295 #define AMR_DER_FCS			0x08
296 #define AMR_DER_OVFL			0x10
297 #define AMR_DER_UNFL			0x20
298 #define AMR_DER_OVRN			0x40
299 #define AMR_DER_UNRN			0x80
300 
301 /* Peripheral Port */
302 #define	AMR_PP_PPCR1			0xC0
303 #define	AMR_PP_PPSR			0xC1
304 #define	AMR_PP_PPIER			0xC2
305 #define	AMR_PP_MTDR			0xC3
306 #define	AMR_PP_MRDR			0xC3
307 #define	AMR_PP_CITDR0			0xC4
308 #define	AMR_PP_CIRDR0			0xC4
309 #define	AMR_PP_CITDR1			0xC5
310 #define	AMR_PP_CIRDR1			0xC5
311 #define	AMR_PP_PPCR2			0xC8
312 #define	AMR_PP_PPCR3			0xC9
313 
314 struct snd_amd7930 {
315 	spinlock_t		lock;
316 	void __iomem		*regs;
317 	u32			flags;
318 #define AMD7930_FLAG_PLAYBACK	0x00000001
319 #define AMD7930_FLAG_CAPTURE	0x00000002
320 
321 	struct amd7930_map	map;
322 
323 	struct snd_card		*card;
324 	struct snd_pcm		*pcm;
325 	struct snd_pcm_substream	*playback_substream;
326 	struct snd_pcm_substream	*capture_substream;
327 
328 	/* Playback/Capture buffer state. */
329 	unsigned char		*p_orig, *p_cur;
330 	int			p_left;
331 	unsigned char		*c_orig, *c_cur;
332 	int			c_left;
333 
334 	int			rgain;
335 	int			pgain;
336 	int			mgain;
337 
338 	struct platform_device	*op;
339 	unsigned int		irq;
340 	struct snd_amd7930	*next;
341 };
342 
343 static struct snd_amd7930 *amd7930_list;
344 
345 /* Idle the AMD7930 chip.  The amd->lock is not held.  */
amd7930_idle(struct snd_amd7930 * amd)346 static __inline__ void amd7930_idle(struct snd_amd7930 *amd)
347 {
348 	unsigned long flags;
349 
350 	spin_lock_irqsave(&amd->lock, flags);
351 	sbus_writeb(AMR_INIT, amd->regs + AMD7930_CR);
352 	sbus_writeb(0, amd->regs + AMD7930_DR);
353 	spin_unlock_irqrestore(&amd->lock, flags);
354 }
355 
356 /* Enable chip interrupts.  The amd->lock is not held.  */
amd7930_enable_ints(struct snd_amd7930 * amd)357 static __inline__ void amd7930_enable_ints(struct snd_amd7930 *amd)
358 {
359 	unsigned long flags;
360 
361 	spin_lock_irqsave(&amd->lock, flags);
362 	sbus_writeb(AMR_INIT, amd->regs + AMD7930_CR);
363 	sbus_writeb(AM_INIT_ACTIVE, amd->regs + AMD7930_DR);
364 	spin_unlock_irqrestore(&amd->lock, flags);
365 }
366 
367 /* Disable chip interrupts.  The amd->lock is not held.  */
amd7930_disable_ints(struct snd_amd7930 * amd)368 static __inline__ void amd7930_disable_ints(struct snd_amd7930 *amd)
369 {
370 	unsigned long flags;
371 
372 	spin_lock_irqsave(&amd->lock, flags);
373 	sbus_writeb(AMR_INIT, amd->regs + AMD7930_CR);
374 	sbus_writeb(AM_INIT_ACTIVE | AM_INIT_DISABLE_INTS, amd->regs + AMD7930_DR);
375 	spin_unlock_irqrestore(&amd->lock, flags);
376 }
377 
378 /* Commit amd7930_map settings to the hardware.
379  * The amd->lock is held and local interrupts are disabled.
380  */
__amd7930_write_map(struct snd_amd7930 * amd)381 static void __amd7930_write_map(struct snd_amd7930 *amd)
382 {
383 	struct amd7930_map *map = &amd->map;
384 
385 	sbus_writeb(AMR_MAP_GX, amd->regs + AMD7930_CR);
386 	sbus_writeb(((map->gx >> 0) & 0xff), amd->regs + AMD7930_DR);
387 	sbus_writeb(((map->gx >> 8) & 0xff), amd->regs + AMD7930_DR);
388 
389 	sbus_writeb(AMR_MAP_GR, amd->regs + AMD7930_CR);
390 	sbus_writeb(((map->gr >> 0) & 0xff), amd->regs + AMD7930_DR);
391 	sbus_writeb(((map->gr >> 8) & 0xff), amd->regs + AMD7930_DR);
392 
393 	sbus_writeb(AMR_MAP_STGR, amd->regs + AMD7930_CR);
394 	sbus_writeb(((map->stgr >> 0) & 0xff), amd->regs + AMD7930_DR);
395 	sbus_writeb(((map->stgr >> 8) & 0xff), amd->regs + AMD7930_DR);
396 
397 	sbus_writeb(AMR_MAP_GER, amd->regs + AMD7930_CR);
398 	sbus_writeb(((map->ger >> 0) & 0xff), amd->regs + AMD7930_DR);
399 	sbus_writeb(((map->ger >> 8) & 0xff), amd->regs + AMD7930_DR);
400 
401 	sbus_writeb(AMR_MAP_MMR1, amd->regs + AMD7930_CR);
402 	sbus_writeb(map->mmr1, amd->regs + AMD7930_DR);
403 
404 	sbus_writeb(AMR_MAP_MMR2, amd->regs + AMD7930_CR);
405 	sbus_writeb(map->mmr2, amd->regs + AMD7930_DR);
406 }
407 
408 /* gx, gr & stg gains.  this table must contain 256 elements with
409  * the 0th being "infinity" (the magic value 9008).  The remaining
410  * elements match sun's gain curve (but with higher resolution):
411  * -18 to 0dB in .16dB steps then 0 to 12dB in .08dB steps.
412  */
413 static __const__ __u16 gx_coeff[256] = {
414 	0x9008, 0x8b7c, 0x8b51, 0x8b45, 0x8b42, 0x8b3b, 0x8b36, 0x8b33,
415 	0x8b32, 0x8b2a, 0x8b2b, 0x8b2c, 0x8b25, 0x8b23, 0x8b22, 0x8b22,
416 	0x9122, 0x8b1a, 0x8aa3, 0x8aa3, 0x8b1c, 0x8aa6, 0x912d, 0x912b,
417 	0x8aab, 0x8b12, 0x8aaa, 0x8ab2, 0x9132, 0x8ab4, 0x913c, 0x8abb,
418 	0x9142, 0x9144, 0x9151, 0x8ad5, 0x8aeb, 0x8a79, 0x8a5a, 0x8a4a,
419 	0x8b03, 0x91c2, 0x91bb, 0x8a3f, 0x8a33, 0x91b2, 0x9212, 0x9213,
420 	0x8a2c, 0x921d, 0x8a23, 0x921a, 0x9222, 0x9223, 0x922d, 0x9231,
421 	0x9234, 0x9242, 0x925b, 0x92dd, 0x92c1, 0x92b3, 0x92ab, 0x92a4,
422 	0x92a2, 0x932b, 0x9341, 0x93d3, 0x93b2, 0x93a2, 0x943c, 0x94b2,
423 	0x953a, 0x9653, 0x9782, 0x9e21, 0x9d23, 0x9cd2, 0x9c23, 0x9baa,
424 	0x9bde, 0x9b33, 0x9b22, 0x9b1d, 0x9ab2, 0xa142, 0xa1e5, 0x9a3b,
425 	0xa213, 0xa1a2, 0xa231, 0xa2eb, 0xa313, 0xa334, 0xa421, 0xa54b,
426 	0xada4, 0xac23, 0xab3b, 0xaaab, 0xaa5c, 0xb1a3, 0xb2ca, 0xb3bd,
427 	0xbe24, 0xbb2b, 0xba33, 0xc32b, 0xcb5a, 0xd2a2, 0xe31d, 0x0808,
428 	0x72ba, 0x62c2, 0x5c32, 0x52db, 0x513e, 0x4cce, 0x43b2, 0x4243,
429 	0x41b4, 0x3b12, 0x3bc3, 0x3df2, 0x34bd, 0x3334, 0x32c2, 0x3224,
430 	0x31aa, 0x2a7b, 0x2aaa, 0x2b23, 0x2bba, 0x2c42, 0x2e23, 0x25bb,
431 	0x242b, 0x240f, 0x231a, 0x22bb, 0x2241, 0x2223, 0x221f, 0x1a33,
432 	0x1a4a, 0x1acd, 0x2132, 0x1b1b, 0x1b2c, 0x1b62, 0x1c12, 0x1c32,
433 	0x1d1b, 0x1e71, 0x16b1, 0x1522, 0x1434, 0x1412, 0x1352, 0x1323,
434 	0x1315, 0x12bc, 0x127a, 0x1235, 0x1226, 0x11a2, 0x1216, 0x0a2a,
435 	0x11bc, 0x11d1, 0x1163, 0x0ac2, 0x0ab2, 0x0aab, 0x0b1b, 0x0b23,
436 	0x0b33, 0x0c0f, 0x0bb3, 0x0c1b, 0x0c3e, 0x0cb1, 0x0d4c, 0x0ec1,
437 	0x079a, 0x0614, 0x0521, 0x047c, 0x0422, 0x03b1, 0x03e3, 0x0333,
438 	0x0322, 0x031c, 0x02aa, 0x02ba, 0x02f2, 0x0242, 0x0232, 0x0227,
439 	0x0222, 0x021b, 0x01ad, 0x0212, 0x01b2, 0x01bb, 0x01cb, 0x01f6,
440 	0x0152, 0x013a, 0x0133, 0x0131, 0x012c, 0x0123, 0x0122, 0x00a2,
441 	0x011b, 0x011e, 0x0114, 0x00b1, 0x00aa, 0x00b3, 0x00bd, 0x00ba,
442 	0x00c5, 0x00d3, 0x00f3, 0x0062, 0x0051, 0x0042, 0x003b, 0x0033,
443 	0x0032, 0x002a, 0x002c, 0x0025, 0x0023, 0x0022, 0x001a, 0x0021,
444 	0x001b, 0x001b, 0x001d, 0x0015, 0x0013, 0x0013, 0x0012, 0x0012,
445 	0x000a, 0x000a, 0x0011, 0x0011, 0x000b, 0x000b, 0x000c, 0x000e,
446 };
447 
448 static __const__ __u16 ger_coeff[] = {
449 	0x431f, /* 5. dB */
450 	0x331f, /* 5.5 dB */
451 	0x40dd, /* 6. dB */
452 	0x11dd, /* 6.5 dB */
453 	0x440f, /* 7. dB */
454 	0x411f, /* 7.5 dB */
455 	0x311f, /* 8. dB */
456 	0x5520, /* 8.5 dB */
457 	0x10dd, /* 9. dB */
458 	0x4211, /* 9.5 dB */
459 	0x410f, /* 10. dB */
460 	0x111f, /* 10.5 dB */
461 	0x600b, /* 11. dB */
462 	0x00dd, /* 11.5 dB */
463 	0x4210, /* 12. dB */
464 	0x110f, /* 13. dB */
465 	0x7200, /* 14. dB */
466 	0x2110, /* 15. dB */
467 	0x2200, /* 15.9 dB */
468 	0x000b, /* 16.9 dB */
469 	0x000f  /* 18. dB */
470 };
471 
472 /* Update amd7930_map settings and program them into the hardware.
473  * The amd->lock is held and local interrupts are disabled.
474  */
__amd7930_update_map(struct snd_amd7930 * amd)475 static void __amd7930_update_map(struct snd_amd7930 *amd)
476 {
477 	struct amd7930_map *map = &amd->map;
478 	int level;
479 
480 	map->gx = gx_coeff[amd->rgain];
481 	map->stgr = gx_coeff[amd->mgain];
482 	level = (amd->pgain * (256 + ARRAY_SIZE(ger_coeff))) >> 8;
483 	if (level >= 256) {
484 		map->ger = ger_coeff[level - 256];
485 		map->gr = gx_coeff[255];
486 	} else {
487 		map->ger = ger_coeff[0];
488 		map->gr = gx_coeff[level];
489 	}
490 	__amd7930_write_map(amd);
491 }
492 
snd_amd7930_interrupt(int irq,void * dev_id)493 static irqreturn_t snd_amd7930_interrupt(int irq, void *dev_id)
494 {
495 	struct snd_amd7930 *amd = dev_id;
496 	unsigned int elapsed;
497 	u8 ir;
498 
499 	spin_lock(&amd->lock);
500 
501 	elapsed = 0;
502 
503 	ir = sbus_readb(amd->regs + AMD7930_IR);
504 	if (ir & AMR_IR_BBUF) {
505 		u8 byte;
506 
507 		if (amd->flags & AMD7930_FLAG_PLAYBACK) {
508 			if (amd->p_left > 0) {
509 				byte = *(amd->p_cur++);
510 				amd->p_left--;
511 				sbus_writeb(byte, amd->regs + AMD7930_BBTB);
512 				if (amd->p_left == 0)
513 					elapsed |= AMD7930_FLAG_PLAYBACK;
514 			} else
515 				sbus_writeb(0, amd->regs + AMD7930_BBTB);
516 		} else if (amd->flags & AMD7930_FLAG_CAPTURE) {
517 			byte = sbus_readb(amd->regs + AMD7930_BBRB);
518 			if (amd->c_left > 0) {
519 				*(amd->c_cur++) = byte;
520 				amd->c_left--;
521 				if (amd->c_left == 0)
522 					elapsed |= AMD7930_FLAG_CAPTURE;
523 			}
524 		}
525 	}
526 	spin_unlock(&amd->lock);
527 
528 	if (elapsed & AMD7930_FLAG_PLAYBACK)
529 		snd_pcm_period_elapsed(amd->playback_substream);
530 	else
531 		snd_pcm_period_elapsed(amd->capture_substream);
532 
533 	return IRQ_HANDLED;
534 }
535 
snd_amd7930_trigger(struct snd_amd7930 * amd,unsigned int flag,int cmd)536 static int snd_amd7930_trigger(struct snd_amd7930 *amd, unsigned int flag, int cmd)
537 {
538 	unsigned long flags;
539 	int result = 0;
540 
541 	spin_lock_irqsave(&amd->lock, flags);
542 	if (cmd == SNDRV_PCM_TRIGGER_START) {
543 		if (!(amd->flags & flag)) {
544 			amd->flags |= flag;
545 
546 			/* Enable B channel interrupts.  */
547 			sbus_writeb(AMR_MUX_MCR4, amd->regs + AMD7930_CR);
548 			sbus_writeb(AM_MUX_MCR4_ENABLE_INTS, amd->regs + AMD7930_DR);
549 		}
550 	} else if (cmd == SNDRV_PCM_TRIGGER_STOP) {
551 		if (amd->flags & flag) {
552 			amd->flags &= ~flag;
553 
554 			/* Disable B channel interrupts.  */
555 			sbus_writeb(AMR_MUX_MCR4, amd->regs + AMD7930_CR);
556 			sbus_writeb(0, amd->regs + AMD7930_DR);
557 		}
558 	} else {
559 		result = -EINVAL;
560 	}
561 	spin_unlock_irqrestore(&amd->lock, flags);
562 
563 	return result;
564 }
565 
snd_amd7930_playback_trigger(struct snd_pcm_substream * substream,int cmd)566 static int snd_amd7930_playback_trigger(struct snd_pcm_substream *substream,
567 					int cmd)
568 {
569 	struct snd_amd7930 *amd = snd_pcm_substream_chip(substream);
570 	return snd_amd7930_trigger(amd, AMD7930_FLAG_PLAYBACK, cmd);
571 }
572 
snd_amd7930_capture_trigger(struct snd_pcm_substream * substream,int cmd)573 static int snd_amd7930_capture_trigger(struct snd_pcm_substream *substream,
574 				       int cmd)
575 {
576 	struct snd_amd7930 *amd = snd_pcm_substream_chip(substream);
577 	return snd_amd7930_trigger(amd, AMD7930_FLAG_CAPTURE, cmd);
578 }
579 
snd_amd7930_playback_prepare(struct snd_pcm_substream * substream)580 static int snd_amd7930_playback_prepare(struct snd_pcm_substream *substream)
581 {
582 	struct snd_amd7930 *amd = snd_pcm_substream_chip(substream);
583 	struct snd_pcm_runtime *runtime = substream->runtime;
584 	unsigned int size = snd_pcm_lib_buffer_bytes(substream);
585 	unsigned long flags;
586 	u8 new_mmr1;
587 
588 	spin_lock_irqsave(&amd->lock, flags);
589 
590 	amd->flags |= AMD7930_FLAG_PLAYBACK;
591 
592 	/* Setup the pseudo-dma transfer pointers.  */
593 	amd->p_orig = amd->p_cur = runtime->dma_area;
594 	amd->p_left = size;
595 
596 	/* Put the chip into the correct encoding format.  */
597 	new_mmr1 = amd->map.mmr1;
598 	if (runtime->format == SNDRV_PCM_FORMAT_A_LAW)
599 		new_mmr1 |= AM_MAP_MMR1_ALAW;
600 	else
601 		new_mmr1 &= ~AM_MAP_MMR1_ALAW;
602 	if (new_mmr1 != amd->map.mmr1) {
603 		amd->map.mmr1 = new_mmr1;
604 		__amd7930_update_map(amd);
605 	}
606 
607 	spin_unlock_irqrestore(&amd->lock, flags);
608 
609 	return 0;
610 }
611 
snd_amd7930_capture_prepare(struct snd_pcm_substream * substream)612 static int snd_amd7930_capture_prepare(struct snd_pcm_substream *substream)
613 {
614 	struct snd_amd7930 *amd = snd_pcm_substream_chip(substream);
615 	struct snd_pcm_runtime *runtime = substream->runtime;
616 	unsigned int size = snd_pcm_lib_buffer_bytes(substream);
617 	unsigned long flags;
618 	u8 new_mmr1;
619 
620 	spin_lock_irqsave(&amd->lock, flags);
621 
622 	amd->flags |= AMD7930_FLAG_CAPTURE;
623 
624 	/* Setup the pseudo-dma transfer pointers.  */
625 	amd->c_orig = amd->c_cur = runtime->dma_area;
626 	amd->c_left = size;
627 
628 	/* Put the chip into the correct encoding format.  */
629 	new_mmr1 = amd->map.mmr1;
630 	if (runtime->format == SNDRV_PCM_FORMAT_A_LAW)
631 		new_mmr1 |= AM_MAP_MMR1_ALAW;
632 	else
633 		new_mmr1 &= ~AM_MAP_MMR1_ALAW;
634 	if (new_mmr1 != amd->map.mmr1) {
635 		amd->map.mmr1 = new_mmr1;
636 		__amd7930_update_map(amd);
637 	}
638 
639 	spin_unlock_irqrestore(&amd->lock, flags);
640 
641 	return 0;
642 }
643 
snd_amd7930_playback_pointer(struct snd_pcm_substream * substream)644 static snd_pcm_uframes_t snd_amd7930_playback_pointer(struct snd_pcm_substream *substream)
645 {
646 	struct snd_amd7930 *amd = snd_pcm_substream_chip(substream);
647 	size_t ptr;
648 
649 	if (!(amd->flags & AMD7930_FLAG_PLAYBACK))
650 		return 0;
651 	ptr = amd->p_cur - amd->p_orig;
652 	return bytes_to_frames(substream->runtime, ptr);
653 }
654 
snd_amd7930_capture_pointer(struct snd_pcm_substream * substream)655 static snd_pcm_uframes_t snd_amd7930_capture_pointer(struct snd_pcm_substream *substream)
656 {
657 	struct snd_amd7930 *amd = snd_pcm_substream_chip(substream);
658 	size_t ptr;
659 
660 	if (!(amd->flags & AMD7930_FLAG_CAPTURE))
661 		return 0;
662 
663 	ptr = amd->c_cur - amd->c_orig;
664 	return bytes_to_frames(substream->runtime, ptr);
665 }
666 
667 /* Playback and capture have identical properties.  */
668 static const struct snd_pcm_hardware snd_amd7930_pcm_hw =
669 {
670 	.info			= (SNDRV_PCM_INFO_MMAP |
671 				   SNDRV_PCM_INFO_MMAP_VALID |
672 				   SNDRV_PCM_INFO_INTERLEAVED |
673 				   SNDRV_PCM_INFO_BLOCK_TRANSFER |
674 				   SNDRV_PCM_INFO_HALF_DUPLEX),
675 	.formats		= SNDRV_PCM_FMTBIT_MU_LAW | SNDRV_PCM_FMTBIT_A_LAW,
676 	.rates			= SNDRV_PCM_RATE_8000,
677 	.rate_min		= 8000,
678 	.rate_max		= 8000,
679 	.channels_min		= 1,
680 	.channels_max		= 1,
681 	.buffer_bytes_max	= (64*1024),
682 	.period_bytes_min	= 1,
683 	.period_bytes_max	= (64*1024),
684 	.periods_min		= 1,
685 	.periods_max		= 1024,
686 };
687 
snd_amd7930_playback_open(struct snd_pcm_substream * substream)688 static int snd_amd7930_playback_open(struct snd_pcm_substream *substream)
689 {
690 	struct snd_amd7930 *amd = snd_pcm_substream_chip(substream);
691 	struct snd_pcm_runtime *runtime = substream->runtime;
692 
693 	amd->playback_substream = substream;
694 	runtime->hw = snd_amd7930_pcm_hw;
695 	return 0;
696 }
697 
snd_amd7930_capture_open(struct snd_pcm_substream * substream)698 static int snd_amd7930_capture_open(struct snd_pcm_substream *substream)
699 {
700 	struct snd_amd7930 *amd = snd_pcm_substream_chip(substream);
701 	struct snd_pcm_runtime *runtime = substream->runtime;
702 
703 	amd->capture_substream = substream;
704 	runtime->hw = snd_amd7930_pcm_hw;
705 	return 0;
706 }
707 
snd_amd7930_playback_close(struct snd_pcm_substream * substream)708 static int snd_amd7930_playback_close(struct snd_pcm_substream *substream)
709 {
710 	struct snd_amd7930 *amd = snd_pcm_substream_chip(substream);
711 
712 	amd->playback_substream = NULL;
713 	return 0;
714 }
715 
snd_amd7930_capture_close(struct snd_pcm_substream * substream)716 static int snd_amd7930_capture_close(struct snd_pcm_substream *substream)
717 {
718 	struct snd_amd7930 *amd = snd_pcm_substream_chip(substream);
719 
720 	amd->capture_substream = NULL;
721 	return 0;
722 }
723 
724 static const struct snd_pcm_ops snd_amd7930_playback_ops = {
725 	.open		=	snd_amd7930_playback_open,
726 	.close		=	snd_amd7930_playback_close,
727 	.prepare	=	snd_amd7930_playback_prepare,
728 	.trigger	=	snd_amd7930_playback_trigger,
729 	.pointer	=	snd_amd7930_playback_pointer,
730 };
731 
732 static const struct snd_pcm_ops snd_amd7930_capture_ops = {
733 	.open		=	snd_amd7930_capture_open,
734 	.close		=	snd_amd7930_capture_close,
735 	.prepare	=	snd_amd7930_capture_prepare,
736 	.trigger	=	snd_amd7930_capture_trigger,
737 	.pointer	=	snd_amd7930_capture_pointer,
738 };
739 
snd_amd7930_pcm(struct snd_amd7930 * amd)740 static int snd_amd7930_pcm(struct snd_amd7930 *amd)
741 {
742 	struct snd_pcm *pcm;
743 	int err;
744 
745 	if ((err = snd_pcm_new(amd->card,
746 			       /* ID */             "sun_amd7930",
747 			       /* device */         0,
748 			       /* playback count */ 1,
749 			       /* capture count */  1, &pcm)) < 0)
750 		return err;
751 
752 	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, &snd_amd7930_playback_ops);
753 	snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, &snd_amd7930_capture_ops);
754 
755 	pcm->private_data = amd;
756 	pcm->info_flags = 0;
757 	strcpy(pcm->name, amd->card->shortname);
758 	amd->pcm = pcm;
759 
760 	snd_pcm_set_managed_buffer_all(pcm, SNDRV_DMA_TYPE_CONTINUOUS,
761 				       NULL, 64*1024, 64*1024);
762 
763 	return 0;
764 }
765 
766 #define VOLUME_MONITOR	0
767 #define VOLUME_CAPTURE	1
768 #define VOLUME_PLAYBACK	2
769 
snd_amd7930_info_volume(struct snd_kcontrol * kctl,struct snd_ctl_elem_info * uinfo)770 static int snd_amd7930_info_volume(struct snd_kcontrol *kctl, struct snd_ctl_elem_info *uinfo)
771 {
772 	uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
773 	uinfo->count = 1;
774 	uinfo->value.integer.min = 0;
775 	uinfo->value.integer.max = 255;
776 
777 	return 0;
778 }
779 
snd_amd7930_get_volume(struct snd_kcontrol * kctl,struct snd_ctl_elem_value * ucontrol)780 static int snd_amd7930_get_volume(struct snd_kcontrol *kctl, struct snd_ctl_elem_value *ucontrol)
781 {
782 	struct snd_amd7930 *amd = snd_kcontrol_chip(kctl);
783 	int type = kctl->private_value;
784 	int *swval;
785 
786 	switch (type) {
787 	case VOLUME_MONITOR:
788 		swval = &amd->mgain;
789 		break;
790 	case VOLUME_CAPTURE:
791 		swval = &amd->rgain;
792 		break;
793 	case VOLUME_PLAYBACK:
794 	default:
795 		swval = &amd->pgain;
796 		break;
797 	}
798 
799 	ucontrol->value.integer.value[0] = *swval;
800 
801 	return 0;
802 }
803 
snd_amd7930_put_volume(struct snd_kcontrol * kctl,struct snd_ctl_elem_value * ucontrol)804 static int snd_amd7930_put_volume(struct snd_kcontrol *kctl, struct snd_ctl_elem_value *ucontrol)
805 {
806 	struct snd_amd7930 *amd = snd_kcontrol_chip(kctl);
807 	unsigned long flags;
808 	int type = kctl->private_value;
809 	int *swval, change;
810 
811 	switch (type) {
812 	case VOLUME_MONITOR:
813 		swval = &amd->mgain;
814 		break;
815 	case VOLUME_CAPTURE:
816 		swval = &amd->rgain;
817 		break;
818 	case VOLUME_PLAYBACK:
819 	default:
820 		swval = &amd->pgain;
821 		break;
822 	}
823 
824 	spin_lock_irqsave(&amd->lock, flags);
825 
826 	if (*swval != ucontrol->value.integer.value[0]) {
827 		*swval = ucontrol->value.integer.value[0] & 0xff;
828 		__amd7930_update_map(amd);
829 		change = 1;
830 	} else
831 		change = 0;
832 
833 	spin_unlock_irqrestore(&amd->lock, flags);
834 
835 	return change;
836 }
837 
838 static const struct snd_kcontrol_new amd7930_controls[] = {
839 	{
840 		.iface		=	SNDRV_CTL_ELEM_IFACE_MIXER,
841 		.name		=	"Monitor Volume",
842 		.index		=	0,
843 		.info		=	snd_amd7930_info_volume,
844 		.get		=	snd_amd7930_get_volume,
845 		.put		=	snd_amd7930_put_volume,
846 		.private_value	=	VOLUME_MONITOR,
847 	},
848 	{
849 		.iface		=	SNDRV_CTL_ELEM_IFACE_MIXER,
850 		.name		=	"Capture Volume",
851 		.index		=	0,
852 		.info		=	snd_amd7930_info_volume,
853 		.get		=	snd_amd7930_get_volume,
854 		.put		=	snd_amd7930_put_volume,
855 		.private_value	=	VOLUME_CAPTURE,
856 	},
857 	{
858 		.iface		=	SNDRV_CTL_ELEM_IFACE_MIXER,
859 		.name		=	"Playback Volume",
860 		.index		=	0,
861 		.info		=	snd_amd7930_info_volume,
862 		.get		=	snd_amd7930_get_volume,
863 		.put		=	snd_amd7930_put_volume,
864 		.private_value	=	VOLUME_PLAYBACK,
865 	},
866 };
867 
snd_amd7930_mixer(struct snd_amd7930 * amd)868 static int snd_amd7930_mixer(struct snd_amd7930 *amd)
869 {
870 	struct snd_card *card;
871 	int idx, err;
872 
873 	if (snd_BUG_ON(!amd || !amd->card))
874 		return -EINVAL;
875 
876 	card = amd->card;
877 	strcpy(card->mixername, card->shortname);
878 
879 	for (idx = 0; idx < ARRAY_SIZE(amd7930_controls); idx++) {
880 		if ((err = snd_ctl_add(card,
881 				       snd_ctl_new1(&amd7930_controls[idx], amd))) < 0)
882 			return err;
883 	}
884 
885 	return 0;
886 }
887 
snd_amd7930_free(struct snd_amd7930 * amd)888 static int snd_amd7930_free(struct snd_amd7930 *amd)
889 {
890 	struct platform_device *op = amd->op;
891 
892 	amd7930_idle(amd);
893 
894 	if (amd->irq)
895 		free_irq(amd->irq, amd);
896 
897 	if (amd->regs)
898 		of_iounmap(&op->resource[0], amd->regs,
899 			   resource_size(&op->resource[0]));
900 
901 	kfree(amd);
902 
903 	return 0;
904 }
905 
snd_amd7930_dev_free(struct snd_device * device)906 static int snd_amd7930_dev_free(struct snd_device *device)
907 {
908 	struct snd_amd7930 *amd = device->device_data;
909 
910 	return snd_amd7930_free(amd);
911 }
912 
913 static const struct snd_device_ops snd_amd7930_dev_ops = {
914 	.dev_free	=	snd_amd7930_dev_free,
915 };
916 
snd_amd7930_create(struct snd_card * card,struct platform_device * op,int irq,int dev,struct snd_amd7930 ** ramd)917 static int snd_amd7930_create(struct snd_card *card,
918 			      struct platform_device *op,
919 			      int irq, int dev,
920 			      struct snd_amd7930 **ramd)
921 {
922 	struct snd_amd7930 *amd;
923 	unsigned long flags;
924 	int err;
925 
926 	*ramd = NULL;
927 	amd = kzalloc(sizeof(*amd), GFP_KERNEL);
928 	if (amd == NULL)
929 		return -ENOMEM;
930 
931 	spin_lock_init(&amd->lock);
932 	amd->card = card;
933 	amd->op = op;
934 
935 	amd->regs = of_ioremap(&op->resource[0], 0,
936 			       resource_size(&op->resource[0]), "amd7930");
937 	if (!amd->regs) {
938 		snd_printk(KERN_ERR
939 			   "amd7930-%d: Unable to map chip registers.\n", dev);
940 		kfree(amd);
941 		return -EIO;
942 	}
943 
944 	amd7930_idle(amd);
945 
946 	if (request_irq(irq, snd_amd7930_interrupt,
947 			IRQF_SHARED, "amd7930", amd)) {
948 		snd_printk(KERN_ERR "amd7930-%d: Unable to grab IRQ %d\n",
949 			   dev, irq);
950 		snd_amd7930_free(amd);
951 		return -EBUSY;
952 	}
953 	amd->irq = irq;
954 
955 	amd7930_enable_ints(amd);
956 
957 	spin_lock_irqsave(&amd->lock, flags);
958 
959 	amd->rgain = 128;
960 	amd->pgain = 200;
961 	amd->mgain = 0;
962 
963 	memset(&amd->map, 0, sizeof(amd->map));
964 	amd->map.mmr1 = (AM_MAP_MMR1_GX | AM_MAP_MMR1_GER |
965 			 AM_MAP_MMR1_GR | AM_MAP_MMR1_STG);
966 	amd->map.mmr2 = (AM_MAP_MMR2_LS | AM_MAP_MMR2_AINB);
967 
968 	__amd7930_update_map(amd);
969 
970 	/* Always MUX audio (Ba) to channel Bb. */
971 	sbus_writeb(AMR_MUX_MCR1, amd->regs + AMD7930_CR);
972 	sbus_writeb(AM_MUX_CHANNEL_Ba | (AM_MUX_CHANNEL_Bb << 4),
973 		    amd->regs + AMD7930_DR);
974 
975 	spin_unlock_irqrestore(&amd->lock, flags);
976 
977 	err = snd_device_new(card, SNDRV_DEV_LOWLEVEL,
978 			     amd, &snd_amd7930_dev_ops);
979 	if (err < 0) {
980 		snd_amd7930_free(amd);
981 		return err;
982 	}
983 
984 	*ramd = amd;
985 	return 0;
986 }
987 
amd7930_sbus_probe(struct platform_device * op)988 static int amd7930_sbus_probe(struct platform_device *op)
989 {
990 	struct resource *rp = &op->resource[0];
991 	static int dev_num;
992 	struct snd_card *card;
993 	struct snd_amd7930 *amd;
994 	int err, irq;
995 
996 	irq = op->archdata.irqs[0];
997 
998 	if (dev_num >= SNDRV_CARDS)
999 		return -ENODEV;
1000 	if (!enable[dev_num]) {
1001 		dev_num++;
1002 		return -ENOENT;
1003 	}
1004 
1005 	err = snd_card_new(&op->dev, index[dev_num], id[dev_num],
1006 			   THIS_MODULE, 0, &card);
1007 	if (err < 0)
1008 		return err;
1009 
1010 	strcpy(card->driver, "AMD7930");
1011 	strcpy(card->shortname, "Sun AMD7930");
1012 	sprintf(card->longname, "%s at 0x%02lx:0x%08Lx, irq %d",
1013 		card->shortname,
1014 		rp->flags & 0xffL,
1015 		(unsigned long long)rp->start,
1016 		irq);
1017 
1018 	if ((err = snd_amd7930_create(card, op,
1019 				      irq, dev_num, &amd)) < 0)
1020 		goto out_err;
1021 
1022 	err = snd_amd7930_pcm(amd);
1023 	if (err < 0)
1024 		goto out_err;
1025 
1026 	err = snd_amd7930_mixer(amd);
1027 	if (err < 0)
1028 		goto out_err;
1029 
1030 	err = snd_card_register(card);
1031 	if (err < 0)
1032 		goto out_err;
1033 
1034 	amd->next = amd7930_list;
1035 	amd7930_list = amd;
1036 
1037 	dev_num++;
1038 
1039 	return 0;
1040 
1041 out_err:
1042 	snd_card_free(card);
1043 	return err;
1044 }
1045 
1046 static const struct of_device_id amd7930_match[] = {
1047 	{
1048 		.name = "audio",
1049 	},
1050 	{},
1051 };
1052 MODULE_DEVICE_TABLE(of, amd7930_match);
1053 
1054 static struct platform_driver amd7930_sbus_driver = {
1055 	.driver = {
1056 		.name = "audio",
1057 		.of_match_table = amd7930_match,
1058 	},
1059 	.probe		= amd7930_sbus_probe,
1060 };
1061 
amd7930_init(void)1062 static int __init amd7930_init(void)
1063 {
1064 	return platform_driver_register(&amd7930_sbus_driver);
1065 }
1066 
amd7930_exit(void)1067 static void __exit amd7930_exit(void)
1068 {
1069 	struct snd_amd7930 *p = amd7930_list;
1070 
1071 	while (p != NULL) {
1072 		struct snd_amd7930 *next = p->next;
1073 
1074 		snd_card_free(p->card);
1075 
1076 		p = next;
1077 	}
1078 
1079 	amd7930_list = NULL;
1080 
1081 	platform_driver_unregister(&amd7930_sbus_driver);
1082 }
1083 
1084 module_init(amd7930_init);
1085 module_exit(amd7930_exit);
1086