amd7930.c 30 KB

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