es1371.c 92 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098
  1. /*****************************************************************************/
  2. /*
  3. * es1371.c -- Creative Ensoniq ES1371.
  4. *
  5. * Copyright (C) 1998-2001, 2003 Thomas Sailer (t.sailer@alumni.ethz.ch)
  6. *
  7. * This program is free software; you can redistribute it and/or modify
  8. * it under the terms of the GNU General Public License as published by
  9. * the Free Software Foundation; either version 2 of the License, or
  10. * (at your option) any later version.
  11. *
  12. * This program is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  15. * GNU General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU General Public License
  18. * along with this program; if not, write to the Free Software
  19. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  20. *
  21. * Special thanks to Ensoniq
  22. *
  23. * Supported devices:
  24. * /dev/dsp standard /dev/dsp device, (mostly) OSS compatible
  25. * /dev/mixer standard /dev/mixer device, (mostly) OSS compatible
  26. * /dev/dsp1 additional DAC, like /dev/dsp, but outputs to mixer "SYNTH" setting
  27. * /dev/midi simple MIDI UART interface, no ioctl
  28. *
  29. * NOTE: the card does not have any FM/Wavetable synthesizer, it is supposed
  30. * to be done in software. That is what /dev/dac is for. By now (Q2 1998)
  31. * there are several MIDI to PCM (WAV) packages, one of them is timidity.
  32. *
  33. * Revision history
  34. * 04.06.1998 0.1 Initial release
  35. * Mixer stuff should be overhauled; especially optional AC97 mixer bits
  36. * should be detected. This results in strange behaviour of some mixer
  37. * settings, like master volume and mic.
  38. * 08.06.1998 0.2 First release using Alan Cox' soundcore instead of miscdevice
  39. * 03.08.1998 0.3 Do not include modversions.h
  40. * Now mixer behaviour can basically be selected between
  41. * "OSS documented" and "OSS actual" behaviour
  42. * 31.08.1998 0.4 Fix realplayer problems - dac.count issues
  43. * 27.10.1998 0.5 Fix joystick support
  44. * -- Oliver Neukum (c188@org.chemie.uni-muenchen.de)
  45. * 10.12.1998 0.6 Fix drain_dac trying to wait on not yet initialized DMA
  46. * 23.12.1998 0.7 Fix a few f_file & FMODE_ bugs
  47. * Don't wake up app until there are fragsize bytes to read/write
  48. * 06.01.1999 0.8 remove the silly SA_INTERRUPT flag.
  49. * hopefully killed the egcs section type conflict
  50. * 12.03.1999 0.9 cinfo.blocks should be reset after GETxPTR ioctl.
  51. * reported by Johan Maes <joma@telindus.be>
  52. * 22.03.1999 0.10 return EAGAIN instead of EBUSY when O_NONBLOCK
  53. * read/write cannot be executed
  54. * 07.04.1999 0.11 implemented the following ioctl's: SOUND_PCM_READ_RATE,
  55. * SOUND_PCM_READ_CHANNELS, SOUND_PCM_READ_BITS;
  56. * Alpha fixes reported by Peter Jones <pjones@redhat.com>
  57. * Another Alpha fix (wait_src_ready in init routine)
  58. * reported by "Ivan N. Kokshaysky" <ink@jurassic.park.msu.ru>
  59. * Note: joystick address handling might still be wrong on archs
  60. * other than i386
  61. * 15.06.1999 0.12 Fix bad allocation bug.
  62. * Thanks to Deti Fliegl <fliegl@in.tum.de>
  63. * 28.06.1999 0.13 Add pci_set_master
  64. * 03.08.1999 0.14 adapt to Linus' new __setup/__initcall
  65. * added kernel command line option "es1371=joystickaddr"
  66. * removed CONFIG_SOUND_ES1371_JOYPORT_BOOT kludge
  67. * 10.08.1999 0.15 (Re)added S/PDIF module option for cards revision >= 4.
  68. * Initial version by Dave Platt <dplatt@snulbug.mtview.ca.us>.
  69. * module_init/__setup fixes
  70. * 08.16.1999 0.16 Joe Cotellese <joec@ensoniq.com>
  71. * Added detection for ES1371 revision ID so that we can
  72. * detect the ES1373 and later parts.
  73. * added AC97 #defines for readability
  74. * added a /proc file system for dumping hardware state
  75. * updated SRC and CODEC w/r functions to accommodate bugs
  76. * in some versions of the ES137x chips.
  77. * 31.08.1999 0.17 add spin_lock_init
  78. * replaced current->state = x with set_current_state(x)
  79. * 03.09.1999 0.18 change read semantics for MIDI to match
  80. * OSS more closely; remove possible wakeup race
  81. * 21.10.1999 0.19 Round sampling rates, requested by
  82. * Kasamatsu Kenichi <t29w0267@ip.media.kyoto-u.ac.jp>
  83. * 27.10.1999 0.20 Added SigmaTel 3D enhancement string
  84. * Codec ID printing changes
  85. * 28.10.1999 0.21 More waitqueue races fixed
  86. * Joe Cotellese <joec@ensoniq.com>
  87. * Changed PCI detection routine so we can more easily
  88. * detect ES137x chip and derivatives.
  89. * 05.01.2000 0.22 Should now work with rev7 boards; patch by
  90. * Eric Lemar, elemar@cs.washington.edu
  91. * 08.01.2000 0.23 Prevent some ioctl's from returning bad count values on underrun/overrun;
  92. * Tim Janik's BSE (Bedevilled Sound Engine) found this
  93. * 07.02.2000 0.24 Use pci_alloc_consistent and pci_register_driver
  94. * 07.02.2000 0.25 Use ac97_codec
  95. * 01.03.2000 0.26 SPDIF patch by Mikael Bouillot <mikael.bouillot@bigfoot.com>
  96. * Use pci_module_init
  97. * 21.11.2000 0.27 Initialize dma buffers in poll, otherwise poll may return a bogus mask
  98. * 12.12.2000 0.28 More dma buffer initializations, patch from
  99. * Tjeerd Mulder <tjeerd.mulder@fujitsu-siemens.com>
  100. * 05.01.2001 0.29 Hopefully updates will not be required anymore when Creative bumps
  101. * the CT5880 revision.
  102. * suggested by Stephan Müller <smueller@chronox.de>
  103. * 31.01.2001 0.30 Register/Unregister gameport
  104. * Fix SETTRIGGER non OSS API conformity
  105. * 14.07.2001 0.31 Add list of laptops needing amplifier control
  106. * 03.01.2003 0.32 open_mode fixes from Georg Acher <acher@in.tum.de>
  107. */
  108. /*****************************************************************************/
  109. #include <linux/interrupt.h>
  110. #include <linux/module.h>
  111. #include <linux/string.h>
  112. #include <linux/ioport.h>
  113. #include <linux/sched.h>
  114. #include <linux/delay.h>
  115. #include <linux/sound.h>
  116. #include <linux/slab.h>
  117. #include <linux/soundcard.h>
  118. #include <linux/pci.h>
  119. #include <linux/init.h>
  120. #include <linux/poll.h>
  121. #include <linux/bitops.h>
  122. #include <linux/proc_fs.h>
  123. #include <linux/spinlock.h>
  124. #include <linux/smp_lock.h>
  125. #include <linux/ac97_codec.h>
  126. #include <linux/gameport.h>
  127. #include <linux/wait.h>
  128. #include <linux/dma-mapping.h>
  129. #include <asm/io.h>
  130. #include <asm/page.h>
  131. #include <asm/uaccess.h>
  132. /* --------------------------------------------------------------------- */
  133. #undef OSS_DOCUMENTED_MIXER_SEMANTICS
  134. #define ES1371_DEBUG
  135. #define DBG(x) {}
  136. /*#define DBG(x) {x}*/
  137. /* --------------------------------------------------------------------- */
  138. #ifndef PCI_VENDOR_ID_ENSONIQ
  139. #define PCI_VENDOR_ID_ENSONIQ 0x1274
  140. #endif
  141. #ifndef PCI_VENDOR_ID_ECTIVA
  142. #define PCI_VENDOR_ID_ECTIVA 0x1102
  143. #endif
  144. #ifndef PCI_DEVICE_ID_ENSONIQ_ES1371
  145. #define PCI_DEVICE_ID_ENSONIQ_ES1371 0x1371
  146. #endif
  147. #ifndef PCI_DEVICE_ID_ENSONIQ_CT5880
  148. #define PCI_DEVICE_ID_ENSONIQ_CT5880 0x5880
  149. #endif
  150. #ifndef PCI_DEVICE_ID_ECTIVA_EV1938
  151. #define PCI_DEVICE_ID_ECTIVA_EV1938 0x8938
  152. #endif
  153. /* ES1371 chip ID */
  154. /* This is a little confusing because all ES1371 compatible chips have the
  155. same DEVICE_ID, the only thing differentiating them is the REV_ID field.
  156. This is only significant if you want to enable features on the later parts.
  157. Yes, I know it's stupid and why didn't we use the sub IDs?
  158. */
  159. #define ES1371REV_ES1373_A 0x04
  160. #define ES1371REV_ES1373_B 0x06
  161. #define ES1371REV_CT5880_A 0x07
  162. #define CT5880REV_CT5880_C 0x02
  163. #define CT5880REV_CT5880_D 0x03
  164. #define ES1371REV_ES1371_B 0x09
  165. #define EV1938REV_EV1938_A 0x00
  166. #define ES1371REV_ES1373_8 0x08
  167. #define ES1371_MAGIC ((PCI_VENDOR_ID_ENSONIQ<<16)|PCI_DEVICE_ID_ENSONIQ_ES1371)
  168. #define ES1371_EXTENT 0x40
  169. #define JOY_EXTENT 8
  170. #define ES1371_REG_CONTROL 0x00
  171. #define ES1371_REG_STATUS 0x04 /* on the 5880 it is control/status */
  172. #define ES1371_REG_UART_DATA 0x08
  173. #define ES1371_REG_UART_STATUS 0x09
  174. #define ES1371_REG_UART_CONTROL 0x09
  175. #define ES1371_REG_UART_TEST 0x0a
  176. #define ES1371_REG_MEMPAGE 0x0c
  177. #define ES1371_REG_SRCONV 0x10
  178. #define ES1371_REG_CODEC 0x14
  179. #define ES1371_REG_LEGACY 0x18
  180. #define ES1371_REG_SERIAL_CONTROL 0x20
  181. #define ES1371_REG_DAC1_SCOUNT 0x24
  182. #define ES1371_REG_DAC2_SCOUNT 0x28
  183. #define ES1371_REG_ADC_SCOUNT 0x2c
  184. #define ES1371_REG_DAC1_FRAMEADR 0xc30
  185. #define ES1371_REG_DAC1_FRAMECNT 0xc34
  186. #define ES1371_REG_DAC2_FRAMEADR 0xc38
  187. #define ES1371_REG_DAC2_FRAMECNT 0xc3c
  188. #define ES1371_REG_ADC_FRAMEADR 0xd30
  189. #define ES1371_REG_ADC_FRAMECNT 0xd34
  190. #define ES1371_FMT_U8_MONO 0
  191. #define ES1371_FMT_U8_STEREO 1
  192. #define ES1371_FMT_S16_MONO 2
  193. #define ES1371_FMT_S16_STEREO 3
  194. #define ES1371_FMT_STEREO 1
  195. #define ES1371_FMT_S16 2
  196. #define ES1371_FMT_MASK 3
  197. static const unsigned sample_size[] = { 1, 2, 2, 4 };
  198. static const unsigned sample_shift[] = { 0, 1, 1, 2 };
  199. #define CTRL_RECEN_B 0x08000000 /* 1 = don't mix analog in to digital out */
  200. #define CTRL_SPDIFEN_B 0x04000000
  201. #define CTRL_JOY_SHIFT 24
  202. #define CTRL_JOY_MASK 3
  203. #define CTRL_JOY_200 0x00000000 /* joystick base address */
  204. #define CTRL_JOY_208 0x01000000
  205. #define CTRL_JOY_210 0x02000000
  206. #define CTRL_JOY_218 0x03000000
  207. #define CTRL_GPIO_IN0 0x00100000 /* general purpose inputs/outputs */
  208. #define CTRL_GPIO_IN1 0x00200000
  209. #define CTRL_GPIO_IN2 0x00400000
  210. #define CTRL_GPIO_IN3 0x00800000
  211. #define CTRL_GPIO_OUT0 0x00010000
  212. #define CTRL_GPIO_OUT1 0x00020000
  213. #define CTRL_GPIO_OUT2 0x00040000
  214. #define CTRL_GPIO_OUT3 0x00080000
  215. #define CTRL_MSFMTSEL 0x00008000 /* MPEG serial data fmt: 0 = Sony, 1 = I2S */
  216. #define CTRL_SYNCRES 0x00004000 /* AC97 warm reset */
  217. #define CTRL_ADCSTOP 0x00002000 /* stop ADC transfers */
  218. #define CTRL_PWR_INTRM 0x00001000 /* 1 = power level ints enabled */
  219. #define CTRL_M_CB 0x00000800 /* recording source: 0 = ADC, 1 = MPEG */
  220. #define CTRL_CCB_INTRM 0x00000400 /* 1 = CCB "voice" ints enabled */
  221. #define CTRL_PDLEV0 0x00000000 /* power down level */
  222. #define CTRL_PDLEV1 0x00000100
  223. #define CTRL_PDLEV2 0x00000200
  224. #define CTRL_PDLEV3 0x00000300
  225. #define CTRL_BREQ 0x00000080 /* 1 = test mode (internal mem test) */
  226. #define CTRL_DAC1_EN 0x00000040 /* enable DAC1 */
  227. #define CTRL_DAC2_EN 0x00000020 /* enable DAC2 */
  228. #define CTRL_ADC_EN 0x00000010 /* enable ADC */
  229. #define CTRL_UART_EN 0x00000008 /* enable MIDI uart */
  230. #define CTRL_JYSTK_EN 0x00000004 /* enable Joystick port */
  231. #define CTRL_XTALCLKDIS 0x00000002 /* 1 = disable crystal clock input */
  232. #define CTRL_PCICLKDIS 0x00000001 /* 1 = disable PCI clock distribution */
  233. #define STAT_INTR 0x80000000 /* wired or of all interrupt bits */
  234. #define CSTAT_5880_AC97_RST 0x20000000 /* CT5880 Reset bit */
  235. #define STAT_EN_SPDIF 0x00040000 /* enable S/PDIF circuitry */
  236. #define STAT_TS_SPDIF 0x00020000 /* test S/PDIF circuitry */
  237. #define STAT_TESTMODE 0x00010000 /* test ASIC */
  238. #define STAT_SYNC_ERR 0x00000100 /* 1 = codec sync error */
  239. #define STAT_VC 0x000000c0 /* CCB int source, 0=DAC1, 1=DAC2, 2=ADC, 3=undef */
  240. #define STAT_SH_VC 6
  241. #define STAT_MPWR 0x00000020 /* power level interrupt */
  242. #define STAT_MCCB 0x00000010 /* CCB int pending */
  243. #define STAT_UART 0x00000008 /* UART int pending */
  244. #define STAT_DAC1 0x00000004 /* DAC1 int pending */
  245. #define STAT_DAC2 0x00000002 /* DAC2 int pending */
  246. #define STAT_ADC 0x00000001 /* ADC int pending */
  247. #define USTAT_RXINT 0x80 /* UART rx int pending */
  248. #define USTAT_TXINT 0x04 /* UART tx int pending */
  249. #define USTAT_TXRDY 0x02 /* UART tx ready */
  250. #define USTAT_RXRDY 0x01 /* UART rx ready */
  251. #define UCTRL_RXINTEN 0x80 /* 1 = enable RX ints */
  252. #define UCTRL_TXINTEN 0x60 /* TX int enable field mask */
  253. #define UCTRL_ENA_TXINT 0x20 /* enable TX int */
  254. #define UCTRL_CNTRL 0x03 /* control field */
  255. #define UCTRL_CNTRL_SWR 0x03 /* software reset command */
  256. /* sample rate converter */
  257. #define SRC_OKSTATE 1
  258. #define SRC_RAMADDR_MASK 0xfe000000
  259. #define SRC_RAMADDR_SHIFT 25
  260. #define SRC_DAC1FREEZE (1UL << 21)
  261. #define SRC_DAC2FREEZE (1UL << 20)
  262. #define SRC_ADCFREEZE (1UL << 19)
  263. #define SRC_WE 0x01000000 /* read/write control for SRC RAM */
  264. #define SRC_BUSY 0x00800000 /* SRC busy */
  265. #define SRC_DIS 0x00400000 /* 1 = disable SRC */
  266. #define SRC_DDAC1 0x00200000 /* 1 = disable accum update for DAC1 */
  267. #define SRC_DDAC2 0x00100000 /* 1 = disable accum update for DAC2 */
  268. #define SRC_DADC 0x00080000 /* 1 = disable accum update for ADC2 */
  269. #define SRC_CTLMASK 0x00780000
  270. #define SRC_RAMDATA_MASK 0x0000ffff
  271. #define SRC_RAMDATA_SHIFT 0
  272. #define SRCREG_ADC 0x78
  273. #define SRCREG_DAC1 0x70
  274. #define SRCREG_DAC2 0x74
  275. #define SRCREG_VOL_ADC 0x6c
  276. #define SRCREG_VOL_DAC1 0x7c
  277. #define SRCREG_VOL_DAC2 0x7e
  278. #define SRCREG_TRUNC_N 0x00
  279. #define SRCREG_INT_REGS 0x01
  280. #define SRCREG_ACCUM_FRAC 0x02
  281. #define SRCREG_VFREQ_FRAC 0x03
  282. #define CODEC_PIRD 0x00800000 /* 0 = write AC97 register */
  283. #define CODEC_PIADD_MASK 0x007f0000
  284. #define CODEC_PIADD_SHIFT 16
  285. #define CODEC_PIDAT_MASK 0x0000ffff
  286. #define CODEC_PIDAT_SHIFT 0
  287. #define CODEC_RDY 0x80000000 /* AC97 read data valid */
  288. #define CODEC_WIP 0x40000000 /* AC97 write in progress */
  289. #define CODEC_PORD 0x00800000 /* 0 = write AC97 register */
  290. #define CODEC_POADD_MASK 0x007f0000
  291. #define CODEC_POADD_SHIFT 16
  292. #define CODEC_PODAT_MASK 0x0000ffff
  293. #define CODEC_PODAT_SHIFT 0
  294. #define LEGACY_JFAST 0x80000000 /* fast joystick timing */
  295. #define LEGACY_FIRQ 0x01000000 /* force IRQ */
  296. #define SCTRL_DACTEST 0x00400000 /* 1 = DAC test, test vector generation purposes */
  297. #define SCTRL_P2ENDINC 0x00380000 /* */
  298. #define SCTRL_SH_P2ENDINC 19
  299. #define SCTRL_P2STINC 0x00070000 /* */
  300. #define SCTRL_SH_P2STINC 16
  301. #define SCTRL_R1LOOPSEL 0x00008000 /* 0 = loop mode */
  302. #define SCTRL_P2LOOPSEL 0x00004000 /* 0 = loop mode */
  303. #define SCTRL_P1LOOPSEL 0x00002000 /* 0 = loop mode */
  304. #define SCTRL_P2PAUSE 0x00001000 /* 1 = pause mode */
  305. #define SCTRL_P1PAUSE 0x00000800 /* 1 = pause mode */
  306. #define SCTRL_R1INTEN 0x00000400 /* enable interrupt */
  307. #define SCTRL_P2INTEN 0x00000200 /* enable interrupt */
  308. #define SCTRL_P1INTEN 0x00000100 /* enable interrupt */
  309. #define SCTRL_P1SCTRLD 0x00000080 /* reload sample count register for DAC1 */
  310. #define SCTRL_P2DACSEN 0x00000040 /* 1 = DAC2 play back last sample when disabled */
  311. #define SCTRL_R1SEB 0x00000020 /* 1 = 16bit */
  312. #define SCTRL_R1SMB 0x00000010 /* 1 = stereo */
  313. #define SCTRL_R1FMT 0x00000030 /* format mask */
  314. #define SCTRL_SH_R1FMT 4
  315. #define SCTRL_P2SEB 0x00000008 /* 1 = 16bit */
  316. #define SCTRL_P2SMB 0x00000004 /* 1 = stereo */
  317. #define SCTRL_P2FMT 0x0000000c /* format mask */
  318. #define SCTRL_SH_P2FMT 2
  319. #define SCTRL_P1SEB 0x00000002 /* 1 = 16bit */
  320. #define SCTRL_P1SMB 0x00000001 /* 1 = stereo */
  321. #define SCTRL_P1FMT 0x00000003 /* format mask */
  322. #define SCTRL_SH_P1FMT 0
  323. /* misc stuff */
  324. #define POLL_COUNT 0x1000
  325. #define FMODE_DAC 4 /* slight misuse of mode_t */
  326. /* MIDI buffer sizes */
  327. #define MIDIINBUF 256
  328. #define MIDIOUTBUF 256
  329. #define FMODE_MIDI_SHIFT 3
  330. #define FMODE_MIDI_READ (FMODE_READ << FMODE_MIDI_SHIFT)
  331. #define FMODE_MIDI_WRITE (FMODE_WRITE << FMODE_MIDI_SHIFT)
  332. #define ES1371_MODULE_NAME "es1371"
  333. #define PFX ES1371_MODULE_NAME ": "
  334. /* --------------------------------------------------------------------- */
  335. struct es1371_state {
  336. /* magic */
  337. unsigned int magic;
  338. /* list of es1371 devices */
  339. struct list_head devs;
  340. /* the corresponding pci_dev structure */
  341. struct pci_dev *dev;
  342. /* soundcore stuff */
  343. int dev_audio;
  344. int dev_dac;
  345. int dev_midi;
  346. /* hardware resources */
  347. unsigned long io; /* long for SPARC */
  348. unsigned int irq;
  349. /* PCI ID's */
  350. u16 vendor;
  351. u16 device;
  352. u8 rev; /* the chip revision */
  353. /* options */
  354. int spdif_volume; /* S/PDIF output is enabled if != -1 */
  355. #ifdef ES1371_DEBUG
  356. /* debug /proc entry */
  357. struct proc_dir_entry *ps;
  358. #endif /* ES1371_DEBUG */
  359. struct ac97_codec *codec;
  360. /* wave stuff */
  361. unsigned ctrl;
  362. unsigned sctrl;
  363. unsigned dac1rate, dac2rate, adcrate;
  364. spinlock_t lock;
  365. struct semaphore open_sem;
  366. mode_t open_mode;
  367. wait_queue_head_t open_wait;
  368. struct dmabuf {
  369. void *rawbuf;
  370. dma_addr_t dmaaddr;
  371. unsigned buforder;
  372. unsigned numfrag;
  373. unsigned fragshift;
  374. unsigned hwptr, swptr;
  375. unsigned total_bytes;
  376. int count;
  377. unsigned error; /* over/underrun */
  378. wait_queue_head_t wait;
  379. /* redundant, but makes calculations easier */
  380. unsigned fragsize;
  381. unsigned dmasize;
  382. unsigned fragsamples;
  383. /* OSS stuff */
  384. unsigned mapped:1;
  385. unsigned ready:1;
  386. unsigned endcleared:1;
  387. unsigned enabled:1;
  388. unsigned ossfragshift;
  389. int ossmaxfrags;
  390. unsigned subdivision;
  391. } dma_dac1, dma_dac2, dma_adc;
  392. /* midi stuff */
  393. struct {
  394. unsigned ird, iwr, icnt;
  395. unsigned ord, owr, ocnt;
  396. wait_queue_head_t iwait;
  397. wait_queue_head_t owait;
  398. unsigned char ibuf[MIDIINBUF];
  399. unsigned char obuf[MIDIOUTBUF];
  400. } midi;
  401. struct gameport *gameport;
  402. struct semaphore sem;
  403. };
  404. /* --------------------------------------------------------------------- */
  405. static LIST_HEAD(devs);
  406. /* --------------------------------------------------------------------- */
  407. static inline unsigned ld2(unsigned int x)
  408. {
  409. unsigned r = 0;
  410. if (x >= 0x10000) {
  411. x >>= 16;
  412. r += 16;
  413. }
  414. if (x >= 0x100) {
  415. x >>= 8;
  416. r += 8;
  417. }
  418. if (x >= 0x10) {
  419. x >>= 4;
  420. r += 4;
  421. }
  422. if (x >= 4) {
  423. x >>= 2;
  424. r += 2;
  425. }
  426. if (x >= 2)
  427. r++;
  428. return r;
  429. }
  430. /* --------------------------------------------------------------------- */
  431. static unsigned wait_src_ready(struct es1371_state *s)
  432. {
  433. unsigned int t, r;
  434. for (t = 0; t < POLL_COUNT; t++) {
  435. if (!((r = inl(s->io + ES1371_REG_SRCONV)) & SRC_BUSY))
  436. return r;
  437. udelay(1);
  438. }
  439. printk(KERN_DEBUG PFX "sample rate converter timeout r = 0x%08x\n", r);
  440. return r;
  441. }
  442. static unsigned src_read(struct es1371_state *s, unsigned reg)
  443. {
  444. unsigned int temp,i,orig;
  445. /* wait for ready */
  446. temp = wait_src_ready (s);
  447. /* we can only access the SRC at certain times, make sure
  448. we're allowed to before we read */
  449. orig = temp;
  450. /* expose the SRC state bits */
  451. outl ( (temp & SRC_CTLMASK) | (reg << SRC_RAMADDR_SHIFT) | 0x10000UL,
  452. s->io + ES1371_REG_SRCONV);
  453. /* now, wait for busy and the correct time to read */
  454. temp = wait_src_ready (s);
  455. if ( (temp & 0x00870000UL ) != ( SRC_OKSTATE << 16 )){
  456. /* wait for the right state */
  457. for (i=0; i<POLL_COUNT; i++){
  458. temp = inl (s->io + ES1371_REG_SRCONV);
  459. if ( (temp & 0x00870000UL ) == ( SRC_OKSTATE << 16 ))
  460. break;
  461. }
  462. }
  463. /* hide the state bits */
  464. outl ((orig & SRC_CTLMASK) | (reg << SRC_RAMADDR_SHIFT), s->io + ES1371_REG_SRCONV);
  465. return temp;
  466. }
  467. static void src_write(struct es1371_state *s, unsigned reg, unsigned data)
  468. {
  469. unsigned int r;
  470. r = wait_src_ready(s) & (SRC_DIS | SRC_DDAC1 | SRC_DDAC2 | SRC_DADC);
  471. r |= (reg << SRC_RAMADDR_SHIFT) & SRC_RAMADDR_MASK;
  472. r |= (data << SRC_RAMDATA_SHIFT) & SRC_RAMDATA_MASK;
  473. outl(r | SRC_WE, s->io + ES1371_REG_SRCONV);
  474. }
  475. /* --------------------------------------------------------------------- */
  476. /* most of the following here is black magic */
  477. static void set_adc_rate(struct es1371_state *s, unsigned rate)
  478. {
  479. unsigned long flags;
  480. unsigned int n, truncm, freq;
  481. if (rate > 48000)
  482. rate = 48000;
  483. if (rate < 4000)
  484. rate = 4000;
  485. n = rate / 3000;
  486. if ((1 << n) & ((1 << 15) | (1 << 13) | (1 << 11) | (1 << 9)))
  487. n--;
  488. truncm = (21 * n - 1) | 1;
  489. freq = ((48000UL << 15) / rate) * n;
  490. s->adcrate = (48000UL << 15) / (freq / n);
  491. spin_lock_irqsave(&s->lock, flags);
  492. if (rate >= 24000) {
  493. if (truncm > 239)
  494. truncm = 239;
  495. src_write(s, SRCREG_ADC+SRCREG_TRUNC_N,
  496. (((239 - truncm) >> 1) << 9) | (n << 4));
  497. } else {
  498. if (truncm > 119)
  499. truncm = 119;
  500. src_write(s, SRCREG_ADC+SRCREG_TRUNC_N,
  501. 0x8000 | (((119 - truncm) >> 1) << 9) | (n << 4));
  502. }
  503. src_write(s, SRCREG_ADC+SRCREG_INT_REGS,
  504. (src_read(s, SRCREG_ADC+SRCREG_INT_REGS) & 0x00ff) |
  505. ((freq >> 5) & 0xfc00));
  506. src_write(s, SRCREG_ADC+SRCREG_VFREQ_FRAC, freq & 0x7fff);
  507. src_write(s, SRCREG_VOL_ADC, n << 8);
  508. src_write(s, SRCREG_VOL_ADC+1, n << 8);
  509. spin_unlock_irqrestore(&s->lock, flags);
  510. }
  511. static void set_dac1_rate(struct es1371_state *s, unsigned rate)
  512. {
  513. unsigned long flags;
  514. unsigned int freq, r;
  515. if (rate > 48000)
  516. rate = 48000;
  517. if (rate < 4000)
  518. rate = 4000;
  519. freq = ((rate << 15) + 1500) / 3000;
  520. s->dac1rate = (freq * 3000 + 16384) >> 15;
  521. spin_lock_irqsave(&s->lock, flags);
  522. r = (wait_src_ready(s) & (SRC_DIS | SRC_DDAC2 | SRC_DADC)) | SRC_DDAC1;
  523. outl(r, s->io + ES1371_REG_SRCONV);
  524. src_write(s, SRCREG_DAC1+SRCREG_INT_REGS,
  525. (src_read(s, SRCREG_DAC1+SRCREG_INT_REGS) & 0x00ff) |
  526. ((freq >> 5) & 0xfc00));
  527. src_write(s, SRCREG_DAC1+SRCREG_VFREQ_FRAC, freq & 0x7fff);
  528. r = (wait_src_ready(s) & (SRC_DIS | SRC_DDAC2 | SRC_DADC));
  529. outl(r, s->io + ES1371_REG_SRCONV);
  530. spin_unlock_irqrestore(&s->lock, flags);
  531. }
  532. static void set_dac2_rate(struct es1371_state *s, unsigned rate)
  533. {
  534. unsigned long flags;
  535. unsigned int freq, r;
  536. if (rate > 48000)
  537. rate = 48000;
  538. if (rate < 4000)
  539. rate = 4000;
  540. freq = ((rate << 15) + 1500) / 3000;
  541. s->dac2rate = (freq * 3000 + 16384) >> 15;
  542. spin_lock_irqsave(&s->lock, flags);
  543. r = (wait_src_ready(s) & (SRC_DIS | SRC_DDAC1 | SRC_DADC)) | SRC_DDAC2;
  544. outl(r, s->io + ES1371_REG_SRCONV);
  545. src_write(s, SRCREG_DAC2+SRCREG_INT_REGS,
  546. (src_read(s, SRCREG_DAC2+SRCREG_INT_REGS) & 0x00ff) |
  547. ((freq >> 5) & 0xfc00));
  548. src_write(s, SRCREG_DAC2+SRCREG_VFREQ_FRAC, freq & 0x7fff);
  549. r = (wait_src_ready(s) & (SRC_DIS | SRC_DDAC1 | SRC_DADC));
  550. outl(r, s->io + ES1371_REG_SRCONV);
  551. spin_unlock_irqrestore(&s->lock, flags);
  552. }
  553. /* --------------------------------------------------------------------- */
  554. static void __devinit src_init(struct es1371_state *s)
  555. {
  556. unsigned int i;
  557. /* before we enable or disable the SRC we need
  558. to wait for it to become ready */
  559. wait_src_ready(s);
  560. outl(SRC_DIS, s->io + ES1371_REG_SRCONV);
  561. for (i = 0; i < 0x80; i++)
  562. src_write(s, i, 0);
  563. src_write(s, SRCREG_DAC1+SRCREG_TRUNC_N, 16 << 4);
  564. src_write(s, SRCREG_DAC1+SRCREG_INT_REGS, 16 << 10);
  565. src_write(s, SRCREG_DAC2+SRCREG_TRUNC_N, 16 << 4);
  566. src_write(s, SRCREG_DAC2+SRCREG_INT_REGS, 16 << 10);
  567. src_write(s, SRCREG_VOL_ADC, 1 << 12);
  568. src_write(s, SRCREG_VOL_ADC+1, 1 << 12);
  569. src_write(s, SRCREG_VOL_DAC1, 1 << 12);
  570. src_write(s, SRCREG_VOL_DAC1+1, 1 << 12);
  571. src_write(s, SRCREG_VOL_DAC2, 1 << 12);
  572. src_write(s, SRCREG_VOL_DAC2+1, 1 << 12);
  573. set_adc_rate(s, 22050);
  574. set_dac1_rate(s, 22050);
  575. set_dac2_rate(s, 22050);
  576. /* WARNING:
  577. * enabling the sample rate converter without properly programming
  578. * its parameters causes the chip to lock up (the SRC busy bit will
  579. * be stuck high, and I've found no way to rectify this other than
  580. * power cycle)
  581. */
  582. wait_src_ready(s);
  583. outl(0, s->io+ES1371_REG_SRCONV);
  584. }
  585. /* --------------------------------------------------------------------- */
  586. static void wrcodec(struct ac97_codec *codec, u8 addr, u16 data)
  587. {
  588. struct es1371_state *s = (struct es1371_state *)codec->private_data;
  589. unsigned long flags;
  590. unsigned t, x;
  591. spin_lock_irqsave(&s->lock, flags);
  592. for (t = 0; t < POLL_COUNT; t++)
  593. if (!(inl(s->io+ES1371_REG_CODEC) & CODEC_WIP))
  594. break;
  595. /* save the current state for later */
  596. x = wait_src_ready(s);
  597. /* enable SRC state data in SRC mux */
  598. outl((x & (SRC_DIS | SRC_DDAC1 | SRC_DDAC2 | SRC_DADC)) | 0x00010000,
  599. s->io+ES1371_REG_SRCONV);
  600. /* wait for not busy (state 0) first to avoid
  601. transition states */
  602. for (t=0; t<POLL_COUNT; t++){
  603. if((inl(s->io+ES1371_REG_SRCONV) & 0x00870000) ==0 )
  604. break;
  605. udelay(1);
  606. }
  607. /* wait for a SAFE time to write addr/data and then do it, dammit */
  608. for (t=0; t<POLL_COUNT; t++){
  609. if((inl(s->io+ES1371_REG_SRCONV) & 0x00870000) ==0x00010000)
  610. break;
  611. udelay(1);
  612. }
  613. outl(((addr << CODEC_POADD_SHIFT) & CODEC_POADD_MASK) |
  614. ((data << CODEC_PODAT_SHIFT) & CODEC_PODAT_MASK), s->io+ES1371_REG_CODEC);
  615. /* restore SRC reg */
  616. wait_src_ready(s);
  617. outl(x, s->io+ES1371_REG_SRCONV);
  618. spin_unlock_irqrestore(&s->lock, flags);
  619. }
  620. static u16 rdcodec(struct ac97_codec *codec, u8 addr)
  621. {
  622. struct es1371_state *s = (struct es1371_state *)codec->private_data;
  623. unsigned long flags;
  624. unsigned t, x;
  625. spin_lock_irqsave(&s->lock, flags);
  626. /* wait for WIP to go away */
  627. for (t = 0; t < 0x1000; t++)
  628. if (!(inl(s->io+ES1371_REG_CODEC) & CODEC_WIP))
  629. break;
  630. /* save the current state for later */
  631. x = (wait_src_ready(s) & (SRC_DIS | SRC_DDAC1 | SRC_DDAC2 | SRC_DADC));
  632. /* enable SRC state data in SRC mux */
  633. outl( x | 0x00010000,
  634. s->io+ES1371_REG_SRCONV);
  635. /* wait for not busy (state 0) first to avoid
  636. transition states */
  637. for (t=0; t<POLL_COUNT; t++){
  638. if((inl(s->io+ES1371_REG_SRCONV) & 0x00870000) ==0 )
  639. break;
  640. udelay(1);
  641. }
  642. /* wait for a SAFE time to write addr/data and then do it, dammit */
  643. for (t=0; t<POLL_COUNT; t++){
  644. if((inl(s->io+ES1371_REG_SRCONV) & 0x00870000) ==0x00010000)
  645. break;
  646. udelay(1);
  647. }
  648. outl(((addr << CODEC_POADD_SHIFT) & CODEC_POADD_MASK) | CODEC_PORD, s->io+ES1371_REG_CODEC);
  649. /* restore SRC reg */
  650. wait_src_ready(s);
  651. outl(x, s->io+ES1371_REG_SRCONV);
  652. /* wait for WIP again */
  653. for (t = 0; t < 0x1000; t++)
  654. if (!(inl(s->io+ES1371_REG_CODEC) & CODEC_WIP))
  655. break;
  656. /* now wait for the stinkin' data (RDY) */
  657. for (t = 0; t < POLL_COUNT; t++)
  658. if ((x = inl(s->io+ES1371_REG_CODEC)) & CODEC_RDY)
  659. break;
  660. spin_unlock_irqrestore(&s->lock, flags);
  661. return ((x & CODEC_PIDAT_MASK) >> CODEC_PIDAT_SHIFT);
  662. }
  663. /* --------------------------------------------------------------------- */
  664. static inline void stop_adc(struct es1371_state *s)
  665. {
  666. unsigned long flags;
  667. spin_lock_irqsave(&s->lock, flags);
  668. s->ctrl &= ~CTRL_ADC_EN;
  669. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  670. spin_unlock_irqrestore(&s->lock, flags);
  671. }
  672. static inline void stop_dac1(struct es1371_state *s)
  673. {
  674. unsigned long flags;
  675. spin_lock_irqsave(&s->lock, flags);
  676. s->ctrl &= ~CTRL_DAC1_EN;
  677. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  678. spin_unlock_irqrestore(&s->lock, flags);
  679. }
  680. static inline void stop_dac2(struct es1371_state *s)
  681. {
  682. unsigned long flags;
  683. spin_lock_irqsave(&s->lock, flags);
  684. s->ctrl &= ~CTRL_DAC2_EN;
  685. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  686. spin_unlock_irqrestore(&s->lock, flags);
  687. }
  688. static void start_dac1(struct es1371_state *s)
  689. {
  690. unsigned long flags;
  691. unsigned fragremain, fshift;
  692. spin_lock_irqsave(&s->lock, flags);
  693. if (!(s->ctrl & CTRL_DAC1_EN) && (s->dma_dac1.mapped || s->dma_dac1.count > 0)
  694. && s->dma_dac1.ready) {
  695. s->ctrl |= CTRL_DAC1_EN;
  696. s->sctrl = (s->sctrl & ~(SCTRL_P1LOOPSEL | SCTRL_P1PAUSE | SCTRL_P1SCTRLD)) | SCTRL_P1INTEN;
  697. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  698. fragremain = ((- s->dma_dac1.hwptr) & (s->dma_dac1.fragsize-1));
  699. fshift = sample_shift[(s->sctrl & SCTRL_P1FMT) >> SCTRL_SH_P1FMT];
  700. if (fragremain < 2*fshift)
  701. fragremain = s->dma_dac1.fragsize;
  702. outl((fragremain >> fshift) - 1, s->io+ES1371_REG_DAC1_SCOUNT);
  703. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  704. outl((s->dma_dac1.fragsize >> fshift) - 1, s->io+ES1371_REG_DAC1_SCOUNT);
  705. }
  706. spin_unlock_irqrestore(&s->lock, flags);
  707. }
  708. static void start_dac2(struct es1371_state *s)
  709. {
  710. unsigned long flags;
  711. unsigned fragremain, fshift;
  712. spin_lock_irqsave(&s->lock, flags);
  713. if (!(s->ctrl & CTRL_DAC2_EN) && (s->dma_dac2.mapped || s->dma_dac2.count > 0)
  714. && s->dma_dac2.ready) {
  715. s->ctrl |= CTRL_DAC2_EN;
  716. s->sctrl = (s->sctrl & ~(SCTRL_P2LOOPSEL | SCTRL_P2PAUSE | SCTRL_P2DACSEN |
  717. SCTRL_P2ENDINC | SCTRL_P2STINC)) | SCTRL_P2INTEN |
  718. (((s->sctrl & SCTRL_P2FMT) ? 2 : 1) << SCTRL_SH_P2ENDINC) |
  719. (0 << SCTRL_SH_P2STINC);
  720. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  721. fragremain = ((- s->dma_dac2.hwptr) & (s->dma_dac2.fragsize-1));
  722. fshift = sample_shift[(s->sctrl & SCTRL_P2FMT) >> SCTRL_SH_P2FMT];
  723. if (fragremain < 2*fshift)
  724. fragremain = s->dma_dac2.fragsize;
  725. outl((fragremain >> fshift) - 1, s->io+ES1371_REG_DAC2_SCOUNT);
  726. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  727. outl((s->dma_dac2.fragsize >> fshift) - 1, s->io+ES1371_REG_DAC2_SCOUNT);
  728. }
  729. spin_unlock_irqrestore(&s->lock, flags);
  730. }
  731. static void start_adc(struct es1371_state *s)
  732. {
  733. unsigned long flags;
  734. unsigned fragremain, fshift;
  735. spin_lock_irqsave(&s->lock, flags);
  736. if (!(s->ctrl & CTRL_ADC_EN) && (s->dma_adc.mapped || s->dma_adc.count < (signed)(s->dma_adc.dmasize - 2*s->dma_adc.fragsize))
  737. && s->dma_adc.ready) {
  738. s->ctrl |= CTRL_ADC_EN;
  739. s->sctrl = (s->sctrl & ~SCTRL_R1LOOPSEL) | SCTRL_R1INTEN;
  740. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  741. fragremain = ((- s->dma_adc.hwptr) & (s->dma_adc.fragsize-1));
  742. fshift = sample_shift[(s->sctrl & SCTRL_R1FMT) >> SCTRL_SH_R1FMT];
  743. if (fragremain < 2*fshift)
  744. fragremain = s->dma_adc.fragsize;
  745. outl((fragremain >> fshift) - 1, s->io+ES1371_REG_ADC_SCOUNT);
  746. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  747. outl((s->dma_adc.fragsize >> fshift) - 1, s->io+ES1371_REG_ADC_SCOUNT);
  748. }
  749. spin_unlock_irqrestore(&s->lock, flags);
  750. }
  751. /* --------------------------------------------------------------------- */
  752. #define DMABUF_DEFAULTORDER (17-PAGE_SHIFT)
  753. #define DMABUF_MINORDER 1
  754. static inline void dealloc_dmabuf(struct es1371_state *s, struct dmabuf *db)
  755. {
  756. struct page *page, *pend;
  757. if (db->rawbuf) {
  758. /* undo marking the pages as reserved */
  759. pend = virt_to_page(db->rawbuf + (PAGE_SIZE << db->buforder) - 1);
  760. for (page = virt_to_page(db->rawbuf); page <= pend; page++)
  761. ClearPageReserved(page);
  762. pci_free_consistent(s->dev, PAGE_SIZE << db->buforder, db->rawbuf, db->dmaaddr);
  763. }
  764. db->rawbuf = NULL;
  765. db->mapped = db->ready = 0;
  766. }
  767. static int prog_dmabuf(struct es1371_state *s, struct dmabuf *db, unsigned rate, unsigned fmt, unsigned reg)
  768. {
  769. int order;
  770. unsigned bytepersec;
  771. unsigned bufs;
  772. struct page *page, *pend;
  773. db->hwptr = db->swptr = db->total_bytes = db->count = db->error = db->endcleared = 0;
  774. if (!db->rawbuf) {
  775. db->ready = db->mapped = 0;
  776. for (order = DMABUF_DEFAULTORDER; order >= DMABUF_MINORDER; order--)
  777. if ((db->rawbuf = pci_alloc_consistent(s->dev, PAGE_SIZE << order, &db->dmaaddr)))
  778. break;
  779. if (!db->rawbuf)
  780. return -ENOMEM;
  781. db->buforder = order;
  782. /* now mark the pages as reserved; otherwise remap_pfn_range doesn't do what we want */
  783. pend = virt_to_page(db->rawbuf + (PAGE_SIZE << db->buforder) - 1);
  784. for (page = virt_to_page(db->rawbuf); page <= pend; page++)
  785. SetPageReserved(page);
  786. }
  787. fmt &= ES1371_FMT_MASK;
  788. bytepersec = rate << sample_shift[fmt];
  789. bufs = PAGE_SIZE << db->buforder;
  790. if (db->ossfragshift) {
  791. if ((1000 << db->ossfragshift) < bytepersec)
  792. db->fragshift = ld2(bytepersec/1000);
  793. else
  794. db->fragshift = db->ossfragshift;
  795. } else {
  796. db->fragshift = ld2(bytepersec/100/(db->subdivision ? db->subdivision : 1));
  797. if (db->fragshift < 3)
  798. db->fragshift = 3;
  799. }
  800. db->numfrag = bufs >> db->fragshift;
  801. while (db->numfrag < 4 && db->fragshift > 3) {
  802. db->fragshift--;
  803. db->numfrag = bufs >> db->fragshift;
  804. }
  805. db->fragsize = 1 << db->fragshift;
  806. if (db->ossmaxfrags >= 4 && db->ossmaxfrags < db->numfrag)
  807. db->numfrag = db->ossmaxfrags;
  808. db->fragsamples = db->fragsize >> sample_shift[fmt];
  809. db->dmasize = db->numfrag << db->fragshift;
  810. memset(db->rawbuf, (fmt & ES1371_FMT_S16) ? 0 : 0x80, db->dmasize);
  811. outl((reg >> 8) & 15, s->io+ES1371_REG_MEMPAGE);
  812. outl(db->dmaaddr, s->io+(reg & 0xff));
  813. outl((db->dmasize >> 2)-1, s->io+((reg + 4) & 0xff));
  814. db->enabled = 1;
  815. db->ready = 1;
  816. return 0;
  817. }
  818. static inline int prog_dmabuf_adc(struct es1371_state *s)
  819. {
  820. stop_adc(s);
  821. return prog_dmabuf(s, &s->dma_adc, s->adcrate, (s->sctrl >> SCTRL_SH_R1FMT) & ES1371_FMT_MASK,
  822. ES1371_REG_ADC_FRAMEADR);
  823. }
  824. static inline int prog_dmabuf_dac2(struct es1371_state *s)
  825. {
  826. stop_dac2(s);
  827. return prog_dmabuf(s, &s->dma_dac2, s->dac2rate, (s->sctrl >> SCTRL_SH_P2FMT) & ES1371_FMT_MASK,
  828. ES1371_REG_DAC2_FRAMEADR);
  829. }
  830. static inline int prog_dmabuf_dac1(struct es1371_state *s)
  831. {
  832. stop_dac1(s);
  833. return prog_dmabuf(s, &s->dma_dac1, s->dac1rate, (s->sctrl >> SCTRL_SH_P1FMT) & ES1371_FMT_MASK,
  834. ES1371_REG_DAC1_FRAMEADR);
  835. }
  836. static inline unsigned get_hwptr(struct es1371_state *s, struct dmabuf *db, unsigned reg)
  837. {
  838. unsigned hwptr, diff;
  839. outl((reg >> 8) & 15, s->io+ES1371_REG_MEMPAGE);
  840. hwptr = (inl(s->io+(reg & 0xff)) >> 14) & 0x3fffc;
  841. diff = (db->dmasize + hwptr - db->hwptr) % db->dmasize;
  842. db->hwptr = hwptr;
  843. return diff;
  844. }
  845. static inline void clear_advance(void *buf, unsigned bsize, unsigned bptr, unsigned len, unsigned char c)
  846. {
  847. if (bptr + len > bsize) {
  848. unsigned x = bsize - bptr;
  849. memset(((char *)buf) + bptr, c, x);
  850. bptr = 0;
  851. len -= x;
  852. }
  853. memset(((char *)buf) + bptr, c, len);
  854. }
  855. /* call with spinlock held! */
  856. static void es1371_update_ptr(struct es1371_state *s)
  857. {
  858. int diff;
  859. /* update ADC pointer */
  860. if (s->ctrl & CTRL_ADC_EN) {
  861. diff = get_hwptr(s, &s->dma_adc, ES1371_REG_ADC_FRAMECNT);
  862. s->dma_adc.total_bytes += diff;
  863. s->dma_adc.count += diff;
  864. if (s->dma_adc.count >= (signed)s->dma_adc.fragsize)
  865. wake_up(&s->dma_adc.wait);
  866. if (!s->dma_adc.mapped) {
  867. if (s->dma_adc.count > (signed)(s->dma_adc.dmasize - ((3 * s->dma_adc.fragsize) >> 1))) {
  868. s->ctrl &= ~CTRL_ADC_EN;
  869. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  870. s->dma_adc.error++;
  871. }
  872. }
  873. }
  874. /* update DAC1 pointer */
  875. if (s->ctrl & CTRL_DAC1_EN) {
  876. diff = get_hwptr(s, &s->dma_dac1, ES1371_REG_DAC1_FRAMECNT);
  877. s->dma_dac1.total_bytes += diff;
  878. if (s->dma_dac1.mapped) {
  879. s->dma_dac1.count += diff;
  880. if (s->dma_dac1.count >= (signed)s->dma_dac1.fragsize)
  881. wake_up(&s->dma_dac1.wait);
  882. } else {
  883. s->dma_dac1.count -= diff;
  884. if (s->dma_dac1.count <= 0) {
  885. s->ctrl &= ~CTRL_DAC1_EN;
  886. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  887. s->dma_dac1.error++;
  888. } else if (s->dma_dac1.count <= (signed)s->dma_dac1.fragsize && !s->dma_dac1.endcleared) {
  889. clear_advance(s->dma_dac1.rawbuf, s->dma_dac1.dmasize, s->dma_dac1.swptr,
  890. s->dma_dac1.fragsize, (s->sctrl & SCTRL_P1SEB) ? 0 : 0x80);
  891. s->dma_dac1.endcleared = 1;
  892. }
  893. if (s->dma_dac1.count + (signed)s->dma_dac1.fragsize <= (signed)s->dma_dac1.dmasize)
  894. wake_up(&s->dma_dac1.wait);
  895. }
  896. }
  897. /* update DAC2 pointer */
  898. if (s->ctrl & CTRL_DAC2_EN) {
  899. diff = get_hwptr(s, &s->dma_dac2, ES1371_REG_DAC2_FRAMECNT);
  900. s->dma_dac2.total_bytes += diff;
  901. if (s->dma_dac2.mapped) {
  902. s->dma_dac2.count += diff;
  903. if (s->dma_dac2.count >= (signed)s->dma_dac2.fragsize)
  904. wake_up(&s->dma_dac2.wait);
  905. } else {
  906. s->dma_dac2.count -= diff;
  907. if (s->dma_dac2.count <= 0) {
  908. s->ctrl &= ~CTRL_DAC2_EN;
  909. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  910. s->dma_dac2.error++;
  911. } else if (s->dma_dac2.count <= (signed)s->dma_dac2.fragsize && !s->dma_dac2.endcleared) {
  912. clear_advance(s->dma_dac2.rawbuf, s->dma_dac2.dmasize, s->dma_dac2.swptr,
  913. s->dma_dac2.fragsize, (s->sctrl & SCTRL_P2SEB) ? 0 : 0x80);
  914. s->dma_dac2.endcleared = 1;
  915. }
  916. if (s->dma_dac2.count + (signed)s->dma_dac2.fragsize <= (signed)s->dma_dac2.dmasize)
  917. wake_up(&s->dma_dac2.wait);
  918. }
  919. }
  920. }
  921. /* hold spinlock for the following! */
  922. static void es1371_handle_midi(struct es1371_state *s)
  923. {
  924. unsigned char ch;
  925. int wake;
  926. if (!(s->ctrl & CTRL_UART_EN))
  927. return;
  928. wake = 0;
  929. while (inb(s->io+ES1371_REG_UART_STATUS) & USTAT_RXRDY) {
  930. ch = inb(s->io+ES1371_REG_UART_DATA);
  931. if (s->midi.icnt < MIDIINBUF) {
  932. s->midi.ibuf[s->midi.iwr] = ch;
  933. s->midi.iwr = (s->midi.iwr + 1) % MIDIINBUF;
  934. s->midi.icnt++;
  935. }
  936. wake = 1;
  937. }
  938. if (wake)
  939. wake_up(&s->midi.iwait);
  940. wake = 0;
  941. while ((inb(s->io+ES1371_REG_UART_STATUS) & USTAT_TXRDY) && s->midi.ocnt > 0) {
  942. outb(s->midi.obuf[s->midi.ord], s->io+ES1371_REG_UART_DATA);
  943. s->midi.ord = (s->midi.ord + 1) % MIDIOUTBUF;
  944. s->midi.ocnt--;
  945. if (s->midi.ocnt < MIDIOUTBUF-16)
  946. wake = 1;
  947. }
  948. if (wake)
  949. wake_up(&s->midi.owait);
  950. outb((s->midi.ocnt > 0) ? UCTRL_RXINTEN | UCTRL_ENA_TXINT : UCTRL_RXINTEN, s->io+ES1371_REG_UART_CONTROL);
  951. }
  952. static irqreturn_t es1371_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  953. {
  954. struct es1371_state *s = (struct es1371_state *)dev_id;
  955. unsigned int intsrc, sctl;
  956. /* fastpath out, to ease interrupt sharing */
  957. intsrc = inl(s->io+ES1371_REG_STATUS);
  958. if (!(intsrc & 0x80000000))
  959. return IRQ_NONE;
  960. spin_lock(&s->lock);
  961. /* clear audio interrupts first */
  962. sctl = s->sctrl;
  963. if (intsrc & STAT_ADC)
  964. sctl &= ~SCTRL_R1INTEN;
  965. if (intsrc & STAT_DAC1)
  966. sctl &= ~SCTRL_P1INTEN;
  967. if (intsrc & STAT_DAC2)
  968. sctl &= ~SCTRL_P2INTEN;
  969. outl(sctl, s->io+ES1371_REG_SERIAL_CONTROL);
  970. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  971. es1371_update_ptr(s);
  972. es1371_handle_midi(s);
  973. spin_unlock(&s->lock);
  974. return IRQ_HANDLED;
  975. }
  976. /* --------------------------------------------------------------------- */
  977. static const char invalid_magic[] = KERN_CRIT PFX "invalid magic value\n";
  978. #define VALIDATE_STATE(s) \
  979. ({ \
  980. if (!(s) || (s)->magic != ES1371_MAGIC) { \
  981. printk(invalid_magic); \
  982. return -ENXIO; \
  983. } \
  984. })
  985. /* --------------------------------------------------------------------- */
  986. /* Conversion table for S/PDIF PCM volume emulation through the SRC */
  987. /* dB-linear table of DAC vol values; -0dB to -46.5dB with mute */
  988. static const unsigned short DACVolTable[101] =
  989. {
  990. 0x1000, 0x0f2a, 0x0e60, 0x0da0, 0x0cea, 0x0c3e, 0x0b9a, 0x0aff,
  991. 0x0a6d, 0x09e1, 0x095e, 0x08e1, 0x086a, 0x07fa, 0x078f, 0x072a,
  992. 0x06cb, 0x0670, 0x061a, 0x05c9, 0x057b, 0x0532, 0x04ed, 0x04ab,
  993. 0x046d, 0x0432, 0x03fa, 0x03c5, 0x0392, 0x0363, 0x0335, 0x030b,
  994. 0x02e2, 0x02bc, 0x0297, 0x0275, 0x0254, 0x0235, 0x0217, 0x01fb,
  995. 0x01e1, 0x01c8, 0x01b0, 0x0199, 0x0184, 0x0170, 0x015d, 0x014b,
  996. 0x0139, 0x0129, 0x0119, 0x010b, 0x00fd, 0x00f0, 0x00e3, 0x00d7,
  997. 0x00cc, 0x00c1, 0x00b7, 0x00ae, 0x00a5, 0x009c, 0x0094, 0x008c,
  998. 0x0085, 0x007e, 0x0077, 0x0071, 0x006b, 0x0066, 0x0060, 0x005b,
  999. 0x0057, 0x0052, 0x004e, 0x004a, 0x0046, 0x0042, 0x003f, 0x003c,
  1000. 0x0038, 0x0036, 0x0033, 0x0030, 0x002e, 0x002b, 0x0029, 0x0027,
  1001. 0x0025, 0x0023, 0x0021, 0x001f, 0x001e, 0x001c, 0x001b, 0x0019,
  1002. 0x0018, 0x0017, 0x0016, 0x0014, 0x0000
  1003. };
  1004. /*
  1005. * when we are in S/PDIF mode, we want to disable any analog output so
  1006. * we filter the mixer ioctls
  1007. */
  1008. static int mixdev_ioctl(struct ac97_codec *codec, unsigned int cmd, unsigned long arg)
  1009. {
  1010. struct es1371_state *s = (struct es1371_state *)codec->private_data;
  1011. int val;
  1012. unsigned long flags;
  1013. unsigned int left, right;
  1014. VALIDATE_STATE(s);
  1015. /* filter mixer ioctls to catch PCM and MASTER volume when in S/PDIF mode */
  1016. if (s->spdif_volume == -1)
  1017. return codec->mixer_ioctl(codec, cmd, arg);
  1018. switch (cmd) {
  1019. case SOUND_MIXER_WRITE_VOLUME:
  1020. return 0;
  1021. case SOUND_MIXER_WRITE_PCM: /* use SRC for PCM volume */
  1022. if (get_user(val, (int __user *)arg))
  1023. return -EFAULT;
  1024. right = ((val >> 8) & 0xff);
  1025. left = (val & 0xff);
  1026. if (right > 100)
  1027. right = 100;
  1028. if (left > 100)
  1029. left = 100;
  1030. s->spdif_volume = (right << 8) | left;
  1031. spin_lock_irqsave(&s->lock, flags);
  1032. src_write(s, SRCREG_VOL_DAC2, DACVolTable[100 - left]);
  1033. src_write(s, SRCREG_VOL_DAC2+1, DACVolTable[100 - right]);
  1034. spin_unlock_irqrestore(&s->lock, flags);
  1035. return 0;
  1036. case SOUND_MIXER_READ_PCM:
  1037. return put_user(s->spdif_volume, (int __user *)arg);
  1038. }
  1039. return codec->mixer_ioctl(codec, cmd, arg);
  1040. }
  1041. /* --------------------------------------------------------------------- */
  1042. /*
  1043. * AC97 Mixer Register to Connections mapping of the Concert 97 board
  1044. *
  1045. * AC97_MASTER_VOL_STEREO Line Out
  1046. * AC97_MASTER_VOL_MONO TAD Output
  1047. * AC97_PCBEEP_VOL none
  1048. * AC97_PHONE_VOL TAD Input (mono)
  1049. * AC97_MIC_VOL MIC Input (mono)
  1050. * AC97_LINEIN_VOL Line Input (stereo)
  1051. * AC97_CD_VOL CD Input (stereo)
  1052. * AC97_VIDEO_VOL none
  1053. * AC97_AUX_VOL Aux Input (stereo)
  1054. * AC97_PCMOUT_VOL Wave Output (stereo)
  1055. */
  1056. static int es1371_open_mixdev(struct inode *inode, struct file *file)
  1057. {
  1058. int minor = iminor(inode);
  1059. struct list_head *list;
  1060. struct es1371_state *s;
  1061. for (list = devs.next; ; list = list->next) {
  1062. if (list == &devs)
  1063. return -ENODEV;
  1064. s = list_entry(list, struct es1371_state, devs);
  1065. if (s->codec->dev_mixer == minor)
  1066. break;
  1067. }
  1068. VALIDATE_STATE(s);
  1069. file->private_data = s;
  1070. return nonseekable_open(inode, file);
  1071. }
  1072. static int es1371_release_mixdev(struct inode *inode, struct file *file)
  1073. {
  1074. struct es1371_state *s = (struct es1371_state *)file->private_data;
  1075. VALIDATE_STATE(s);
  1076. return 0;
  1077. }
  1078. static int es1371_ioctl_mixdev(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
  1079. {
  1080. struct es1371_state *s = (struct es1371_state *)file->private_data;
  1081. struct ac97_codec *codec = s->codec;
  1082. return mixdev_ioctl(codec, cmd, arg);
  1083. }
  1084. static /*const*/ struct file_operations es1371_mixer_fops = {
  1085. .owner = THIS_MODULE,
  1086. .llseek = no_llseek,
  1087. .ioctl = es1371_ioctl_mixdev,
  1088. .open = es1371_open_mixdev,
  1089. .release = es1371_release_mixdev,
  1090. };
  1091. /* --------------------------------------------------------------------- */
  1092. static int drain_dac1(struct es1371_state *s, int nonblock)
  1093. {
  1094. DECLARE_WAITQUEUE(wait, current);
  1095. unsigned long flags;
  1096. int count, tmo;
  1097. if (s->dma_dac1.mapped || !s->dma_dac1.ready)
  1098. return 0;
  1099. add_wait_queue(&s->dma_dac1.wait, &wait);
  1100. for (;;) {
  1101. __set_current_state(TASK_INTERRUPTIBLE);
  1102. spin_lock_irqsave(&s->lock, flags);
  1103. count = s->dma_dac1.count;
  1104. spin_unlock_irqrestore(&s->lock, flags);
  1105. if (count <= 0)
  1106. break;
  1107. if (signal_pending(current))
  1108. break;
  1109. if (nonblock) {
  1110. remove_wait_queue(&s->dma_dac1.wait, &wait);
  1111. set_current_state(TASK_RUNNING);
  1112. return -EBUSY;
  1113. }
  1114. tmo = 3 * HZ * (count + s->dma_dac1.fragsize) / 2 / s->dac1rate;
  1115. tmo >>= sample_shift[(s->sctrl & SCTRL_P1FMT) >> SCTRL_SH_P1FMT];
  1116. if (!schedule_timeout(tmo + 1))
  1117. DBG(printk(KERN_DEBUG PFX "dac1 dma timed out??\n");)
  1118. }
  1119. remove_wait_queue(&s->dma_dac1.wait, &wait);
  1120. set_current_state(TASK_RUNNING);
  1121. if (signal_pending(current))
  1122. return -ERESTARTSYS;
  1123. return 0;
  1124. }
  1125. static int drain_dac2(struct es1371_state *s, int nonblock)
  1126. {
  1127. DECLARE_WAITQUEUE(wait, current);
  1128. unsigned long flags;
  1129. int count, tmo;
  1130. if (s->dma_dac2.mapped || !s->dma_dac2.ready)
  1131. return 0;
  1132. add_wait_queue(&s->dma_dac2.wait, &wait);
  1133. for (;;) {
  1134. __set_current_state(TASK_UNINTERRUPTIBLE);
  1135. spin_lock_irqsave(&s->lock, flags);
  1136. count = s->dma_dac2.count;
  1137. spin_unlock_irqrestore(&s->lock, flags);
  1138. if (count <= 0)
  1139. break;
  1140. if (signal_pending(current))
  1141. break;
  1142. if (nonblock) {
  1143. remove_wait_queue(&s->dma_dac2.wait, &wait);
  1144. set_current_state(TASK_RUNNING);
  1145. return -EBUSY;
  1146. }
  1147. tmo = 3 * HZ * (count + s->dma_dac2.fragsize) / 2 / s->dac2rate;
  1148. tmo >>= sample_shift[(s->sctrl & SCTRL_P2FMT) >> SCTRL_SH_P2FMT];
  1149. if (!schedule_timeout(tmo + 1))
  1150. DBG(printk(KERN_DEBUG PFX "dac2 dma timed out??\n");)
  1151. }
  1152. remove_wait_queue(&s->dma_dac2.wait, &wait);
  1153. set_current_state(TASK_RUNNING);
  1154. if (signal_pending(current))
  1155. return -ERESTARTSYS;
  1156. return 0;
  1157. }
  1158. /* --------------------------------------------------------------------- */
  1159. static ssize_t es1371_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos)
  1160. {
  1161. struct es1371_state *s = (struct es1371_state *)file->private_data;
  1162. DECLARE_WAITQUEUE(wait, current);
  1163. ssize_t ret = 0;
  1164. unsigned long flags;
  1165. unsigned swptr;
  1166. int cnt;
  1167. VALIDATE_STATE(s);
  1168. if (s->dma_adc.mapped)
  1169. return -ENXIO;
  1170. if (!access_ok(VERIFY_WRITE, buffer, count))
  1171. return -EFAULT;
  1172. down(&s->sem);
  1173. if (!s->dma_adc.ready && (ret = prog_dmabuf_adc(s)))
  1174. goto out2;
  1175. add_wait_queue(&s->dma_adc.wait, &wait);
  1176. while (count > 0) {
  1177. spin_lock_irqsave(&s->lock, flags);
  1178. swptr = s->dma_adc.swptr;
  1179. cnt = s->dma_adc.dmasize-swptr;
  1180. if (s->dma_adc.count < cnt)
  1181. cnt = s->dma_adc.count;
  1182. if (cnt <= 0)
  1183. __set_current_state(TASK_INTERRUPTIBLE);
  1184. spin_unlock_irqrestore(&s->lock, flags);
  1185. if (cnt > count)
  1186. cnt = count;
  1187. if (cnt <= 0) {
  1188. if (s->dma_adc.enabled)
  1189. start_adc(s);
  1190. if (file->f_flags & O_NONBLOCK) {
  1191. if (!ret)
  1192. ret = -EAGAIN;
  1193. goto out;
  1194. }
  1195. up(&s->sem);
  1196. schedule();
  1197. if (signal_pending(current)) {
  1198. if (!ret)
  1199. ret = -ERESTARTSYS;
  1200. goto out2;
  1201. }
  1202. down(&s->sem);
  1203. if (s->dma_adc.mapped)
  1204. {
  1205. ret = -ENXIO;
  1206. goto out;
  1207. }
  1208. continue;
  1209. }
  1210. if (copy_to_user(buffer, s->dma_adc.rawbuf + swptr, cnt)) {
  1211. if (!ret)
  1212. ret = -EFAULT;
  1213. goto out;
  1214. }
  1215. swptr = (swptr + cnt) % s->dma_adc.dmasize;
  1216. spin_lock_irqsave(&s->lock, flags);
  1217. s->dma_adc.swptr = swptr;
  1218. s->dma_adc.count -= cnt;
  1219. spin_unlock_irqrestore(&s->lock, flags);
  1220. count -= cnt;
  1221. buffer += cnt;
  1222. ret += cnt;
  1223. if (s->dma_adc.enabled)
  1224. start_adc(s);
  1225. }
  1226. out:
  1227. up(&s->sem);
  1228. out2:
  1229. remove_wait_queue(&s->dma_adc.wait, &wait);
  1230. set_current_state(TASK_RUNNING);
  1231. return ret;
  1232. }
  1233. static ssize_t es1371_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
  1234. {
  1235. struct es1371_state *s = (struct es1371_state *)file->private_data;
  1236. DECLARE_WAITQUEUE(wait, current);
  1237. ssize_t ret;
  1238. unsigned long flags;
  1239. unsigned swptr;
  1240. int cnt;
  1241. VALIDATE_STATE(s);
  1242. if (s->dma_dac2.mapped)
  1243. return -ENXIO;
  1244. if (!access_ok(VERIFY_READ, buffer, count))
  1245. return -EFAULT;
  1246. down(&s->sem);
  1247. if (!s->dma_dac2.ready && (ret = prog_dmabuf_dac2(s)))
  1248. goto out3;
  1249. ret = 0;
  1250. add_wait_queue(&s->dma_dac2.wait, &wait);
  1251. while (count > 0) {
  1252. spin_lock_irqsave(&s->lock, flags);
  1253. if (s->dma_dac2.count < 0) {
  1254. s->dma_dac2.count = 0;
  1255. s->dma_dac2.swptr = s->dma_dac2.hwptr;
  1256. }
  1257. swptr = s->dma_dac2.swptr;
  1258. cnt = s->dma_dac2.dmasize-swptr;
  1259. if (s->dma_dac2.count + cnt > s->dma_dac2.dmasize)
  1260. cnt = s->dma_dac2.dmasize - s->dma_dac2.count;
  1261. if (cnt <= 0)
  1262. __set_current_state(TASK_INTERRUPTIBLE);
  1263. spin_unlock_irqrestore(&s->lock, flags);
  1264. if (cnt > count)
  1265. cnt = count;
  1266. if (cnt <= 0) {
  1267. if (s->dma_dac2.enabled)
  1268. start_dac2(s);
  1269. if (file->f_flags & O_NONBLOCK) {
  1270. if (!ret)
  1271. ret = -EAGAIN;
  1272. goto out;
  1273. }
  1274. up(&s->sem);
  1275. schedule();
  1276. if (signal_pending(current)) {
  1277. if (!ret)
  1278. ret = -ERESTARTSYS;
  1279. goto out2;
  1280. }
  1281. down(&s->sem);
  1282. if (s->dma_dac2.mapped)
  1283. {
  1284. ret = -ENXIO;
  1285. goto out;
  1286. }
  1287. continue;
  1288. }
  1289. if (copy_from_user(s->dma_dac2.rawbuf + swptr, buffer, cnt)) {
  1290. if (!ret)
  1291. ret = -EFAULT;
  1292. goto out;
  1293. }
  1294. swptr = (swptr + cnt) % s->dma_dac2.dmasize;
  1295. spin_lock_irqsave(&s->lock, flags);
  1296. s->dma_dac2.swptr = swptr;
  1297. s->dma_dac2.count += cnt;
  1298. s->dma_dac2.endcleared = 0;
  1299. spin_unlock_irqrestore(&s->lock, flags);
  1300. count -= cnt;
  1301. buffer += cnt;
  1302. ret += cnt;
  1303. if (s->dma_dac2.enabled)
  1304. start_dac2(s);
  1305. }
  1306. out:
  1307. up(&s->sem);
  1308. out2:
  1309. remove_wait_queue(&s->dma_dac2.wait, &wait);
  1310. out3:
  1311. set_current_state(TASK_RUNNING);
  1312. return ret;
  1313. }
  1314. /* No kernel lock - we have our own spinlock */
  1315. static unsigned int es1371_poll(struct file *file, struct poll_table_struct *wait)
  1316. {
  1317. struct es1371_state *s = (struct es1371_state *)file->private_data;
  1318. unsigned long flags;
  1319. unsigned int mask = 0;
  1320. VALIDATE_STATE(s);
  1321. if (file->f_mode & FMODE_WRITE) {
  1322. if (!s->dma_dac2.ready && prog_dmabuf_dac2(s))
  1323. return 0;
  1324. poll_wait(file, &s->dma_dac2.wait, wait);
  1325. }
  1326. if (file->f_mode & FMODE_READ) {
  1327. if (!s->dma_adc.ready && prog_dmabuf_adc(s))
  1328. return 0;
  1329. poll_wait(file, &s->dma_adc.wait, wait);
  1330. }
  1331. spin_lock_irqsave(&s->lock, flags);
  1332. es1371_update_ptr(s);
  1333. if (file->f_mode & FMODE_READ) {
  1334. if (s->dma_adc.count >= (signed)s->dma_adc.fragsize)
  1335. mask |= POLLIN | POLLRDNORM;
  1336. }
  1337. if (file->f_mode & FMODE_WRITE) {
  1338. if (s->dma_dac2.mapped) {
  1339. if (s->dma_dac2.count >= (signed)s->dma_dac2.fragsize)
  1340. mask |= POLLOUT | POLLWRNORM;
  1341. } else {
  1342. if ((signed)s->dma_dac2.dmasize >= s->dma_dac2.count + (signed)s->dma_dac2.fragsize)
  1343. mask |= POLLOUT | POLLWRNORM;
  1344. }
  1345. }
  1346. spin_unlock_irqrestore(&s->lock, flags);
  1347. return mask;
  1348. }
  1349. static int es1371_mmap(struct file *file, struct vm_area_struct *vma)
  1350. {
  1351. struct es1371_state *s = (struct es1371_state *)file->private_data;
  1352. struct dmabuf *db;
  1353. int ret = 0;
  1354. unsigned long size;
  1355. VALIDATE_STATE(s);
  1356. lock_kernel();
  1357. down(&s->sem);
  1358. if (vma->vm_flags & VM_WRITE) {
  1359. if ((ret = prog_dmabuf_dac2(s)) != 0) {
  1360. goto out;
  1361. }
  1362. db = &s->dma_dac2;
  1363. } else if (vma->vm_flags & VM_READ) {
  1364. if ((ret = prog_dmabuf_adc(s)) != 0) {
  1365. goto out;
  1366. }
  1367. db = &s->dma_adc;
  1368. } else {
  1369. ret = -EINVAL;
  1370. goto out;
  1371. }
  1372. if (vma->vm_pgoff != 0) {
  1373. ret = -EINVAL;
  1374. goto out;
  1375. }
  1376. size = vma->vm_end - vma->vm_start;
  1377. if (size > (PAGE_SIZE << db->buforder)) {
  1378. ret = -EINVAL;
  1379. goto out;
  1380. }
  1381. if (remap_pfn_range(vma, vma->vm_start,
  1382. virt_to_phys(db->rawbuf) >> PAGE_SHIFT,
  1383. size, vma->vm_page_prot)) {
  1384. ret = -EAGAIN;
  1385. goto out;
  1386. }
  1387. db->mapped = 1;
  1388. out:
  1389. up(&s->sem);
  1390. unlock_kernel();
  1391. return ret;
  1392. }
  1393. static int es1371_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
  1394. {
  1395. struct es1371_state *s = (struct es1371_state *)file->private_data;
  1396. unsigned long flags;
  1397. audio_buf_info abinfo;
  1398. count_info cinfo;
  1399. int count;
  1400. int val, mapped, ret;
  1401. void __user *argp = (void __user *)arg;
  1402. int __user *p = argp;
  1403. VALIDATE_STATE(s);
  1404. mapped = ((file->f_mode & FMODE_WRITE) && s->dma_dac2.mapped) ||
  1405. ((file->f_mode & FMODE_READ) && s->dma_adc.mapped);
  1406. switch (cmd) {
  1407. case OSS_GETVERSION:
  1408. return put_user(SOUND_VERSION, p);
  1409. case SNDCTL_DSP_SYNC:
  1410. if (file->f_mode & FMODE_WRITE)
  1411. return drain_dac2(s, 0/*file->f_flags & O_NONBLOCK*/);
  1412. return 0;
  1413. case SNDCTL_DSP_SETDUPLEX:
  1414. return 0;
  1415. case SNDCTL_DSP_GETCAPS:
  1416. return put_user(DSP_CAP_DUPLEX | DSP_CAP_REALTIME | DSP_CAP_TRIGGER | DSP_CAP_MMAP, p);
  1417. case SNDCTL_DSP_RESET:
  1418. if (file->f_mode & FMODE_WRITE) {
  1419. stop_dac2(s);
  1420. synchronize_irq(s->irq);
  1421. s->dma_dac2.swptr = s->dma_dac2.hwptr = s->dma_dac2.count = s->dma_dac2.total_bytes = 0;
  1422. }
  1423. if (file->f_mode & FMODE_READ) {
  1424. stop_adc(s);
  1425. synchronize_irq(s->irq);
  1426. s->dma_adc.swptr = s->dma_adc.hwptr = s->dma_adc.count = s->dma_adc.total_bytes = 0;
  1427. }
  1428. return 0;
  1429. case SNDCTL_DSP_SPEED:
  1430. if (get_user(val, p))
  1431. return -EFAULT;
  1432. if (val >= 0) {
  1433. if (file->f_mode & FMODE_READ) {
  1434. stop_adc(s);
  1435. s->dma_adc.ready = 0;
  1436. set_adc_rate(s, val);
  1437. }
  1438. if (file->f_mode & FMODE_WRITE) {
  1439. stop_dac2(s);
  1440. s->dma_dac2.ready = 0;
  1441. set_dac2_rate(s, val);
  1442. }
  1443. }
  1444. return put_user((file->f_mode & FMODE_READ) ? s->adcrate : s->dac2rate, p);
  1445. case SNDCTL_DSP_STEREO:
  1446. if (get_user(val, p))
  1447. return -EFAULT;
  1448. if (file->f_mode & FMODE_READ) {
  1449. stop_adc(s);
  1450. s->dma_adc.ready = 0;
  1451. spin_lock_irqsave(&s->lock, flags);
  1452. if (val)
  1453. s->sctrl |= SCTRL_R1SMB;
  1454. else
  1455. s->sctrl &= ~SCTRL_R1SMB;
  1456. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  1457. spin_unlock_irqrestore(&s->lock, flags);
  1458. }
  1459. if (file->f_mode & FMODE_WRITE) {
  1460. stop_dac2(s);
  1461. s->dma_dac2.ready = 0;
  1462. spin_lock_irqsave(&s->lock, flags);
  1463. if (val)
  1464. s->sctrl |= SCTRL_P2SMB;
  1465. else
  1466. s->sctrl &= ~SCTRL_P2SMB;
  1467. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  1468. spin_unlock_irqrestore(&s->lock, flags);
  1469. }
  1470. return 0;
  1471. case SNDCTL_DSP_CHANNELS:
  1472. if (get_user(val, p))
  1473. return -EFAULT;
  1474. if (val != 0) {
  1475. if (file->f_mode & FMODE_READ) {
  1476. stop_adc(s);
  1477. s->dma_adc.ready = 0;
  1478. spin_lock_irqsave(&s->lock, flags);
  1479. if (val >= 2)
  1480. s->sctrl |= SCTRL_R1SMB;
  1481. else
  1482. s->sctrl &= ~SCTRL_R1SMB;
  1483. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  1484. spin_unlock_irqrestore(&s->lock, flags);
  1485. }
  1486. if (file->f_mode & FMODE_WRITE) {
  1487. stop_dac2(s);
  1488. s->dma_dac2.ready = 0;
  1489. spin_lock_irqsave(&s->lock, flags);
  1490. if (val >= 2)
  1491. s->sctrl |= SCTRL_P2SMB;
  1492. else
  1493. s->sctrl &= ~SCTRL_P2SMB;
  1494. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  1495. spin_unlock_irqrestore(&s->lock, flags);
  1496. }
  1497. }
  1498. return put_user((s->sctrl & ((file->f_mode & FMODE_READ) ? SCTRL_R1SMB : SCTRL_P2SMB)) ? 2 : 1, p);
  1499. case SNDCTL_DSP_GETFMTS: /* Returns a mask */
  1500. return put_user(AFMT_S16_LE|AFMT_U8, p);
  1501. case SNDCTL_DSP_SETFMT: /* Selects ONE fmt*/
  1502. if (get_user(val, p))
  1503. return -EFAULT;
  1504. if (val != AFMT_QUERY) {
  1505. if (file->f_mode & FMODE_READ) {
  1506. stop_adc(s);
  1507. s->dma_adc.ready = 0;
  1508. spin_lock_irqsave(&s->lock, flags);
  1509. if (val == AFMT_S16_LE)
  1510. s->sctrl |= SCTRL_R1SEB;
  1511. else
  1512. s->sctrl &= ~SCTRL_R1SEB;
  1513. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  1514. spin_unlock_irqrestore(&s->lock, flags);
  1515. }
  1516. if (file->f_mode & FMODE_WRITE) {
  1517. stop_dac2(s);
  1518. s->dma_dac2.ready = 0;
  1519. spin_lock_irqsave(&s->lock, flags);
  1520. if (val == AFMT_S16_LE)
  1521. s->sctrl |= SCTRL_P2SEB;
  1522. else
  1523. s->sctrl &= ~SCTRL_P2SEB;
  1524. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  1525. spin_unlock_irqrestore(&s->lock, flags);
  1526. }
  1527. }
  1528. return put_user((s->sctrl & ((file->f_mode & FMODE_READ) ? SCTRL_R1SEB : SCTRL_P2SEB)) ?
  1529. AFMT_S16_LE : AFMT_U8, p);
  1530. case SNDCTL_DSP_POST:
  1531. return 0;
  1532. case SNDCTL_DSP_GETTRIGGER:
  1533. val = 0;
  1534. if (file->f_mode & FMODE_READ && s->ctrl & CTRL_ADC_EN)
  1535. val |= PCM_ENABLE_INPUT;
  1536. if (file->f_mode & FMODE_WRITE && s->ctrl & CTRL_DAC2_EN)
  1537. val |= PCM_ENABLE_OUTPUT;
  1538. return put_user(val, p);
  1539. case SNDCTL_DSP_SETTRIGGER:
  1540. if (get_user(val, p))
  1541. return -EFAULT;
  1542. if (file->f_mode & FMODE_READ) {
  1543. if (val & PCM_ENABLE_INPUT) {
  1544. if (!s->dma_adc.ready && (ret = prog_dmabuf_adc(s)))
  1545. return ret;
  1546. s->dma_adc.enabled = 1;
  1547. start_adc(s);
  1548. } else {
  1549. s->dma_adc.enabled = 0;
  1550. stop_adc(s);
  1551. }
  1552. }
  1553. if (file->f_mode & FMODE_WRITE) {
  1554. if (val & PCM_ENABLE_OUTPUT) {
  1555. if (!s->dma_dac2.ready && (ret = prog_dmabuf_dac2(s)))
  1556. return ret;
  1557. s->dma_dac2.enabled = 1;
  1558. start_dac2(s);
  1559. } else {
  1560. s->dma_dac2.enabled = 0;
  1561. stop_dac2(s);
  1562. }
  1563. }
  1564. return 0;
  1565. case SNDCTL_DSP_GETOSPACE:
  1566. if (!(file->f_mode & FMODE_WRITE))
  1567. return -EINVAL;
  1568. if (!s->dma_dac2.ready && (val = prog_dmabuf_dac2(s)) != 0)
  1569. return val;
  1570. spin_lock_irqsave(&s->lock, flags);
  1571. es1371_update_ptr(s);
  1572. abinfo.fragsize = s->dma_dac2.fragsize;
  1573. count = s->dma_dac2.count;
  1574. if (count < 0)
  1575. count = 0;
  1576. abinfo.bytes = s->dma_dac2.dmasize - count;
  1577. abinfo.fragstotal = s->dma_dac2.numfrag;
  1578. abinfo.fragments = abinfo.bytes >> s->dma_dac2.fragshift;
  1579. spin_unlock_irqrestore(&s->lock, flags);
  1580. return copy_to_user(argp, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  1581. case SNDCTL_DSP_GETISPACE:
  1582. if (!(file->f_mode & FMODE_READ))
  1583. return -EINVAL;
  1584. if (!s->dma_adc.ready && (val = prog_dmabuf_adc(s)) != 0)
  1585. return val;
  1586. spin_lock_irqsave(&s->lock, flags);
  1587. es1371_update_ptr(s);
  1588. abinfo.fragsize = s->dma_adc.fragsize;
  1589. count = s->dma_adc.count;
  1590. if (count < 0)
  1591. count = 0;
  1592. abinfo.bytes = count;
  1593. abinfo.fragstotal = s->dma_adc.numfrag;
  1594. abinfo.fragments = abinfo.bytes >> s->dma_adc.fragshift;
  1595. spin_unlock_irqrestore(&s->lock, flags);
  1596. return copy_to_user(argp, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  1597. case SNDCTL_DSP_NONBLOCK:
  1598. file->f_flags |= O_NONBLOCK;
  1599. return 0;
  1600. case SNDCTL_DSP_GETODELAY:
  1601. if (!(file->f_mode & FMODE_WRITE))
  1602. return -EINVAL;
  1603. if (!s->dma_dac2.ready && (val = prog_dmabuf_dac2(s)) != 0)
  1604. return val;
  1605. spin_lock_irqsave(&s->lock, flags);
  1606. es1371_update_ptr(s);
  1607. count = s->dma_dac2.count;
  1608. spin_unlock_irqrestore(&s->lock, flags);
  1609. if (count < 0)
  1610. count = 0;
  1611. return put_user(count, p);
  1612. case SNDCTL_DSP_GETIPTR:
  1613. if (!(file->f_mode & FMODE_READ))
  1614. return -EINVAL;
  1615. if (!s->dma_adc.ready && (val = prog_dmabuf_adc(s)) != 0)
  1616. return val;
  1617. spin_lock_irqsave(&s->lock, flags);
  1618. es1371_update_ptr(s);
  1619. cinfo.bytes = s->dma_adc.total_bytes;
  1620. count = s->dma_adc.count;
  1621. if (count < 0)
  1622. count = 0;
  1623. cinfo.blocks = count >> s->dma_adc.fragshift;
  1624. cinfo.ptr = s->dma_adc.hwptr;
  1625. if (s->dma_adc.mapped)
  1626. s->dma_adc.count &= s->dma_adc.fragsize-1;
  1627. spin_unlock_irqrestore(&s->lock, flags);
  1628. if (copy_to_user(argp, &cinfo, sizeof(cinfo)))
  1629. return -EFAULT;
  1630. return 0;
  1631. case SNDCTL_DSP_GETOPTR:
  1632. if (!(file->f_mode & FMODE_WRITE))
  1633. return -EINVAL;
  1634. if (!s->dma_dac2.ready && (val = prog_dmabuf_dac2(s)) != 0)
  1635. return val;
  1636. spin_lock_irqsave(&s->lock, flags);
  1637. es1371_update_ptr(s);
  1638. cinfo.bytes = s->dma_dac2.total_bytes;
  1639. count = s->dma_dac2.count;
  1640. if (count < 0)
  1641. count = 0;
  1642. cinfo.blocks = count >> s->dma_dac2.fragshift;
  1643. cinfo.ptr = s->dma_dac2.hwptr;
  1644. if (s->dma_dac2.mapped)
  1645. s->dma_dac2.count &= s->dma_dac2.fragsize-1;
  1646. spin_unlock_irqrestore(&s->lock, flags);
  1647. if (copy_to_user(argp, &cinfo, sizeof(cinfo)))
  1648. return -EFAULT;
  1649. return 0;
  1650. case SNDCTL_DSP_GETBLKSIZE:
  1651. if (file->f_mode & FMODE_WRITE) {
  1652. if ((val = prog_dmabuf_dac2(s)))
  1653. return val;
  1654. return put_user(s->dma_dac2.fragsize, p);
  1655. }
  1656. if ((val = prog_dmabuf_adc(s)))
  1657. return val;
  1658. return put_user(s->dma_adc.fragsize, p);
  1659. case SNDCTL_DSP_SETFRAGMENT:
  1660. if (get_user(val, p))
  1661. return -EFAULT;
  1662. if (file->f_mode & FMODE_READ) {
  1663. s->dma_adc.ossfragshift = val & 0xffff;
  1664. s->dma_adc.ossmaxfrags = (val >> 16) & 0xffff;
  1665. if (s->dma_adc.ossfragshift < 4)
  1666. s->dma_adc.ossfragshift = 4;
  1667. if (s->dma_adc.ossfragshift > 15)
  1668. s->dma_adc.ossfragshift = 15;
  1669. if (s->dma_adc.ossmaxfrags < 4)
  1670. s->dma_adc.ossmaxfrags = 4;
  1671. }
  1672. if (file->f_mode & FMODE_WRITE) {
  1673. s->dma_dac2.ossfragshift = val & 0xffff;
  1674. s->dma_dac2.ossmaxfrags = (val >> 16) & 0xffff;
  1675. if (s->dma_dac2.ossfragshift < 4)
  1676. s->dma_dac2.ossfragshift = 4;
  1677. if (s->dma_dac2.ossfragshift > 15)
  1678. s->dma_dac2.ossfragshift = 15;
  1679. if (s->dma_dac2.ossmaxfrags < 4)
  1680. s->dma_dac2.ossmaxfrags = 4;
  1681. }
  1682. return 0;
  1683. case SNDCTL_DSP_SUBDIVIDE:
  1684. if ((file->f_mode & FMODE_READ && s->dma_adc.subdivision) ||
  1685. (file->f_mode & FMODE_WRITE && s->dma_dac2.subdivision))
  1686. return -EINVAL;
  1687. if (get_user(val, p))
  1688. return -EFAULT;
  1689. if (val != 1 && val != 2 && val != 4)
  1690. return -EINVAL;
  1691. if (file->f_mode & FMODE_READ)
  1692. s->dma_adc.subdivision = val;
  1693. if (file->f_mode & FMODE_WRITE)
  1694. s->dma_dac2.subdivision = val;
  1695. return 0;
  1696. case SOUND_PCM_READ_RATE:
  1697. return put_user((file->f_mode & FMODE_READ) ? s->adcrate : s->dac2rate, p);
  1698. case SOUND_PCM_READ_CHANNELS:
  1699. return put_user((s->sctrl & ((file->f_mode & FMODE_READ) ? SCTRL_R1SMB : SCTRL_P2SMB)) ? 2 : 1, p);
  1700. case SOUND_PCM_READ_BITS:
  1701. return put_user((s->sctrl & ((file->f_mode & FMODE_READ) ? SCTRL_R1SEB : SCTRL_P2SEB)) ? 16 : 8, p);
  1702. case SOUND_PCM_WRITE_FILTER:
  1703. case SNDCTL_DSP_SETSYNCRO:
  1704. case SOUND_PCM_READ_FILTER:
  1705. return -EINVAL;
  1706. }
  1707. return mixdev_ioctl(s->codec, cmd, arg);
  1708. }
  1709. static int es1371_open(struct inode *inode, struct file *file)
  1710. {
  1711. int minor = iminor(inode);
  1712. DECLARE_WAITQUEUE(wait, current);
  1713. unsigned long flags;
  1714. struct list_head *list;
  1715. struct es1371_state *s;
  1716. for (list = devs.next; ; list = list->next) {
  1717. if (list == &devs)
  1718. return -ENODEV;
  1719. s = list_entry(list, struct es1371_state, devs);
  1720. if (!((s->dev_audio ^ minor) & ~0xf))
  1721. break;
  1722. }
  1723. VALIDATE_STATE(s);
  1724. file->private_data = s;
  1725. /* wait for device to become free */
  1726. down(&s->open_sem);
  1727. while (s->open_mode & file->f_mode) {
  1728. if (file->f_flags & O_NONBLOCK) {
  1729. up(&s->open_sem);
  1730. return -EBUSY;
  1731. }
  1732. add_wait_queue(&s->open_wait, &wait);
  1733. __set_current_state(TASK_INTERRUPTIBLE);
  1734. up(&s->open_sem);
  1735. schedule();
  1736. remove_wait_queue(&s->open_wait, &wait);
  1737. set_current_state(TASK_RUNNING);
  1738. if (signal_pending(current))
  1739. return -ERESTARTSYS;
  1740. down(&s->open_sem);
  1741. }
  1742. if (file->f_mode & FMODE_READ) {
  1743. s->dma_adc.ossfragshift = s->dma_adc.ossmaxfrags = s->dma_adc.subdivision = 0;
  1744. s->dma_adc.enabled = 1;
  1745. set_adc_rate(s, 8000);
  1746. }
  1747. if (file->f_mode & FMODE_WRITE) {
  1748. s->dma_dac2.ossfragshift = s->dma_dac2.ossmaxfrags = s->dma_dac2.subdivision = 0;
  1749. s->dma_dac2.enabled = 1;
  1750. set_dac2_rate(s, 8000);
  1751. }
  1752. spin_lock_irqsave(&s->lock, flags);
  1753. if (file->f_mode & FMODE_READ) {
  1754. s->sctrl &= ~SCTRL_R1FMT;
  1755. if ((minor & 0xf) == SND_DEV_DSP16)
  1756. s->sctrl |= ES1371_FMT_S16_MONO << SCTRL_SH_R1FMT;
  1757. else
  1758. s->sctrl |= ES1371_FMT_U8_MONO << SCTRL_SH_R1FMT;
  1759. }
  1760. if (file->f_mode & FMODE_WRITE) {
  1761. s->sctrl &= ~SCTRL_P2FMT;
  1762. if ((minor & 0xf) == SND_DEV_DSP16)
  1763. s->sctrl |= ES1371_FMT_S16_MONO << SCTRL_SH_P2FMT;
  1764. else
  1765. s->sctrl |= ES1371_FMT_U8_MONO << SCTRL_SH_P2FMT;
  1766. }
  1767. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  1768. spin_unlock_irqrestore(&s->lock, flags);
  1769. s->open_mode |= file->f_mode & (FMODE_READ | FMODE_WRITE);
  1770. up(&s->open_sem);
  1771. init_MUTEX(&s->sem);
  1772. return nonseekable_open(inode, file);
  1773. }
  1774. static int es1371_release(struct inode *inode, struct file *file)
  1775. {
  1776. struct es1371_state *s = (struct es1371_state *)file->private_data;
  1777. VALIDATE_STATE(s);
  1778. lock_kernel();
  1779. if (file->f_mode & FMODE_WRITE)
  1780. drain_dac2(s, file->f_flags & O_NONBLOCK);
  1781. down(&s->open_sem);
  1782. if (file->f_mode & FMODE_WRITE) {
  1783. stop_dac2(s);
  1784. dealloc_dmabuf(s, &s->dma_dac2);
  1785. }
  1786. if (file->f_mode & FMODE_READ) {
  1787. stop_adc(s);
  1788. dealloc_dmabuf(s, &s->dma_adc);
  1789. }
  1790. s->open_mode &= ~(file->f_mode & (FMODE_READ|FMODE_WRITE));
  1791. up(&s->open_sem);
  1792. wake_up(&s->open_wait);
  1793. unlock_kernel();
  1794. return 0;
  1795. }
  1796. static /*const*/ struct file_operations es1371_audio_fops = {
  1797. .owner = THIS_MODULE,
  1798. .llseek = no_llseek,
  1799. .read = es1371_read,
  1800. .write = es1371_write,
  1801. .poll = es1371_poll,
  1802. .ioctl = es1371_ioctl,
  1803. .mmap = es1371_mmap,
  1804. .open = es1371_open,
  1805. .release = es1371_release,
  1806. };
  1807. /* --------------------------------------------------------------------- */
  1808. static ssize_t es1371_write_dac(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
  1809. {
  1810. struct es1371_state *s = (struct es1371_state *)file->private_data;
  1811. DECLARE_WAITQUEUE(wait, current);
  1812. ssize_t ret = 0;
  1813. unsigned long flags;
  1814. unsigned swptr;
  1815. int cnt;
  1816. VALIDATE_STATE(s);
  1817. if (s->dma_dac1.mapped)
  1818. return -ENXIO;
  1819. if (!s->dma_dac1.ready && (ret = prog_dmabuf_dac1(s)))
  1820. return ret;
  1821. if (!access_ok(VERIFY_READ, buffer, count))
  1822. return -EFAULT;
  1823. add_wait_queue(&s->dma_dac1.wait, &wait);
  1824. while (count > 0) {
  1825. spin_lock_irqsave(&s->lock, flags);
  1826. if (s->dma_dac1.count < 0) {
  1827. s->dma_dac1.count = 0;
  1828. s->dma_dac1.swptr = s->dma_dac1.hwptr;
  1829. }
  1830. swptr = s->dma_dac1.swptr;
  1831. cnt = s->dma_dac1.dmasize-swptr;
  1832. if (s->dma_dac1.count + cnt > s->dma_dac1.dmasize)
  1833. cnt = s->dma_dac1.dmasize - s->dma_dac1.count;
  1834. if (cnt <= 0)
  1835. __set_current_state(TASK_INTERRUPTIBLE);
  1836. spin_unlock_irqrestore(&s->lock, flags);
  1837. if (cnt > count)
  1838. cnt = count;
  1839. if (cnt <= 0) {
  1840. if (s->dma_dac1.enabled)
  1841. start_dac1(s);
  1842. if (file->f_flags & O_NONBLOCK) {
  1843. if (!ret)
  1844. ret = -EAGAIN;
  1845. break;
  1846. }
  1847. schedule();
  1848. if (signal_pending(current)) {
  1849. if (!ret)
  1850. ret = -ERESTARTSYS;
  1851. break;
  1852. }
  1853. continue;
  1854. }
  1855. if (copy_from_user(s->dma_dac1.rawbuf + swptr, buffer, cnt)) {
  1856. if (!ret)
  1857. ret = -EFAULT;
  1858. break;
  1859. }
  1860. swptr = (swptr + cnt) % s->dma_dac1.dmasize;
  1861. spin_lock_irqsave(&s->lock, flags);
  1862. s->dma_dac1.swptr = swptr;
  1863. s->dma_dac1.count += cnt;
  1864. s->dma_dac1.endcleared = 0;
  1865. spin_unlock_irqrestore(&s->lock, flags);
  1866. count -= cnt;
  1867. buffer += cnt;
  1868. ret += cnt;
  1869. if (s->dma_dac1.enabled)
  1870. start_dac1(s);
  1871. }
  1872. remove_wait_queue(&s->dma_dac1.wait, &wait);
  1873. set_current_state(TASK_RUNNING);
  1874. return ret;
  1875. }
  1876. /* No kernel lock - we have our own spinlock */
  1877. static unsigned int es1371_poll_dac(struct file *file, struct poll_table_struct *wait)
  1878. {
  1879. struct es1371_state *s = (struct es1371_state *)file->private_data;
  1880. unsigned long flags;
  1881. unsigned int mask = 0;
  1882. VALIDATE_STATE(s);
  1883. if (!s->dma_dac1.ready && prog_dmabuf_dac1(s))
  1884. return 0;
  1885. poll_wait(file, &s->dma_dac1.wait, wait);
  1886. spin_lock_irqsave(&s->lock, flags);
  1887. es1371_update_ptr(s);
  1888. if (s->dma_dac1.mapped) {
  1889. if (s->dma_dac1.count >= (signed)s->dma_dac1.fragsize)
  1890. mask |= POLLOUT | POLLWRNORM;
  1891. } else {
  1892. if ((signed)s->dma_dac1.dmasize >= s->dma_dac1.count + (signed)s->dma_dac1.fragsize)
  1893. mask |= POLLOUT | POLLWRNORM;
  1894. }
  1895. spin_unlock_irqrestore(&s->lock, flags);
  1896. return mask;
  1897. }
  1898. static int es1371_mmap_dac(struct file *file, struct vm_area_struct *vma)
  1899. {
  1900. struct es1371_state *s = (struct es1371_state *)file->private_data;
  1901. int ret;
  1902. unsigned long size;
  1903. VALIDATE_STATE(s);
  1904. if (!(vma->vm_flags & VM_WRITE))
  1905. return -EINVAL;
  1906. lock_kernel();
  1907. if ((ret = prog_dmabuf_dac1(s)) != 0)
  1908. goto out;
  1909. ret = -EINVAL;
  1910. if (vma->vm_pgoff != 0)
  1911. goto out;
  1912. size = vma->vm_end - vma->vm_start;
  1913. if (size > (PAGE_SIZE << s->dma_dac1.buforder))
  1914. goto out;
  1915. ret = -EAGAIN;
  1916. if (remap_pfn_range(vma, vma->vm_start,
  1917. virt_to_phys(s->dma_dac1.rawbuf) >> PAGE_SHIFT,
  1918. size, vma->vm_page_prot))
  1919. goto out;
  1920. s->dma_dac1.mapped = 1;
  1921. ret = 0;
  1922. out:
  1923. unlock_kernel();
  1924. return ret;
  1925. }
  1926. static int es1371_ioctl_dac(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
  1927. {
  1928. struct es1371_state *s = (struct es1371_state *)file->private_data;
  1929. unsigned long flags;
  1930. audio_buf_info abinfo;
  1931. count_info cinfo;
  1932. int count;
  1933. int val, ret;
  1934. int __user *p = (int __user *)arg;
  1935. VALIDATE_STATE(s);
  1936. switch (cmd) {
  1937. case OSS_GETVERSION:
  1938. return put_user(SOUND_VERSION, p);
  1939. case SNDCTL_DSP_SYNC:
  1940. return drain_dac1(s, 0/*file->f_flags & O_NONBLOCK*/);
  1941. case SNDCTL_DSP_SETDUPLEX:
  1942. return -EINVAL;
  1943. case SNDCTL_DSP_GETCAPS:
  1944. return put_user(DSP_CAP_REALTIME | DSP_CAP_TRIGGER | DSP_CAP_MMAP, p);
  1945. case SNDCTL_DSP_RESET:
  1946. stop_dac1(s);
  1947. synchronize_irq(s->irq);
  1948. s->dma_dac1.swptr = s->dma_dac1.hwptr = s->dma_dac1.count = s->dma_dac1.total_bytes = 0;
  1949. return 0;
  1950. case SNDCTL_DSP_SPEED:
  1951. if (get_user(val, p))
  1952. return -EFAULT;
  1953. if (val >= 0) {
  1954. stop_dac1(s);
  1955. s->dma_dac1.ready = 0;
  1956. set_dac1_rate(s, val);
  1957. }
  1958. return put_user(s->dac1rate, p);
  1959. case SNDCTL_DSP_STEREO:
  1960. if (get_user(val, p))
  1961. return -EFAULT;
  1962. stop_dac1(s);
  1963. s->dma_dac1.ready = 0;
  1964. spin_lock_irqsave(&s->lock, flags);
  1965. if (val)
  1966. s->sctrl |= SCTRL_P1SMB;
  1967. else
  1968. s->sctrl &= ~SCTRL_P1SMB;
  1969. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  1970. spin_unlock_irqrestore(&s->lock, flags);
  1971. return 0;
  1972. case SNDCTL_DSP_CHANNELS:
  1973. if (get_user(val, p))
  1974. return -EFAULT;
  1975. if (val != 0) {
  1976. stop_dac1(s);
  1977. s->dma_dac1.ready = 0;
  1978. spin_lock_irqsave(&s->lock, flags);
  1979. if (val >= 2)
  1980. s->sctrl |= SCTRL_P1SMB;
  1981. else
  1982. s->sctrl &= ~SCTRL_P1SMB;
  1983. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  1984. spin_unlock_irqrestore(&s->lock, flags);
  1985. }
  1986. return put_user((s->sctrl & SCTRL_P1SMB) ? 2 : 1, p);
  1987. case SNDCTL_DSP_GETFMTS: /* Returns a mask */
  1988. return put_user(AFMT_S16_LE|AFMT_U8, p);
  1989. case SNDCTL_DSP_SETFMT: /* Selects ONE fmt*/
  1990. if (get_user(val, p))
  1991. return -EFAULT;
  1992. if (val != AFMT_QUERY) {
  1993. stop_dac1(s);
  1994. s->dma_dac1.ready = 0;
  1995. spin_lock_irqsave(&s->lock, flags);
  1996. if (val == AFMT_S16_LE)
  1997. s->sctrl |= SCTRL_P1SEB;
  1998. else
  1999. s->sctrl &= ~SCTRL_P1SEB;
  2000. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  2001. spin_unlock_irqrestore(&s->lock, flags);
  2002. }
  2003. return put_user((s->sctrl & SCTRL_P1SEB) ? AFMT_S16_LE : AFMT_U8, p);
  2004. case SNDCTL_DSP_POST:
  2005. return 0;
  2006. case SNDCTL_DSP_GETTRIGGER:
  2007. return put_user((s->ctrl & CTRL_DAC1_EN) ? PCM_ENABLE_OUTPUT : 0, p);
  2008. case SNDCTL_DSP_SETTRIGGER:
  2009. if (get_user(val, p))
  2010. return -EFAULT;
  2011. if (val & PCM_ENABLE_OUTPUT) {
  2012. if (!s->dma_dac1.ready && (ret = prog_dmabuf_dac1(s)))
  2013. return ret;
  2014. s->dma_dac1.enabled = 1;
  2015. start_dac1(s);
  2016. } else {
  2017. s->dma_dac1.enabled = 0;
  2018. stop_dac1(s);
  2019. }
  2020. return 0;
  2021. case SNDCTL_DSP_GETOSPACE:
  2022. if (!s->dma_dac1.ready && (val = prog_dmabuf_dac1(s)) != 0)
  2023. return val;
  2024. spin_lock_irqsave(&s->lock, flags);
  2025. es1371_update_ptr(s);
  2026. abinfo.fragsize = s->dma_dac1.fragsize;
  2027. count = s->dma_dac1.count;
  2028. if (count < 0)
  2029. count = 0;
  2030. abinfo.bytes = s->dma_dac1.dmasize - count;
  2031. abinfo.fragstotal = s->dma_dac1.numfrag;
  2032. abinfo.fragments = abinfo.bytes >> s->dma_dac1.fragshift;
  2033. spin_unlock_irqrestore(&s->lock, flags);
  2034. return copy_to_user((void __user *)arg, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  2035. case SNDCTL_DSP_NONBLOCK:
  2036. file->f_flags |= O_NONBLOCK;
  2037. return 0;
  2038. case SNDCTL_DSP_GETODELAY:
  2039. if (!s->dma_dac1.ready && (val = prog_dmabuf_dac1(s)) != 0)
  2040. return val;
  2041. spin_lock_irqsave(&s->lock, flags);
  2042. es1371_update_ptr(s);
  2043. count = s->dma_dac1.count;
  2044. spin_unlock_irqrestore(&s->lock, flags);
  2045. if (count < 0)
  2046. count = 0;
  2047. return put_user(count, p);
  2048. case SNDCTL_DSP_GETOPTR:
  2049. if (!s->dma_dac1.ready && (val = prog_dmabuf_dac1(s)) != 0)
  2050. return val;
  2051. spin_lock_irqsave(&s->lock, flags);
  2052. es1371_update_ptr(s);
  2053. cinfo.bytes = s->dma_dac1.total_bytes;
  2054. count = s->dma_dac1.count;
  2055. if (count < 0)
  2056. count = 0;
  2057. cinfo.blocks = count >> s->dma_dac1.fragshift;
  2058. cinfo.ptr = s->dma_dac1.hwptr;
  2059. if (s->dma_dac1.mapped)
  2060. s->dma_dac1.count &= s->dma_dac1.fragsize-1;
  2061. spin_unlock_irqrestore(&s->lock, flags);
  2062. if (copy_to_user((void __user *)arg, &cinfo, sizeof(cinfo)))
  2063. return -EFAULT;
  2064. return 0;
  2065. case SNDCTL_DSP_GETBLKSIZE:
  2066. if ((val = prog_dmabuf_dac1(s)))
  2067. return val;
  2068. return put_user(s->dma_dac1.fragsize, p);
  2069. case SNDCTL_DSP_SETFRAGMENT:
  2070. if (get_user(val, p))
  2071. return -EFAULT;
  2072. s->dma_dac1.ossfragshift = val & 0xffff;
  2073. s->dma_dac1.ossmaxfrags = (val >> 16) & 0xffff;
  2074. if (s->dma_dac1.ossfragshift < 4)
  2075. s->dma_dac1.ossfragshift = 4;
  2076. if (s->dma_dac1.ossfragshift > 15)
  2077. s->dma_dac1.ossfragshift = 15;
  2078. if (s->dma_dac1.ossmaxfrags < 4)
  2079. s->dma_dac1.ossmaxfrags = 4;
  2080. return 0;
  2081. case SNDCTL_DSP_SUBDIVIDE:
  2082. if (s->dma_dac1.subdivision)
  2083. return -EINVAL;
  2084. if (get_user(val, p))
  2085. return -EFAULT;
  2086. if (val != 1 && val != 2 && val != 4)
  2087. return -EINVAL;
  2088. s->dma_dac1.subdivision = val;
  2089. return 0;
  2090. case SOUND_PCM_READ_RATE:
  2091. return put_user(s->dac1rate, p);
  2092. case SOUND_PCM_READ_CHANNELS:
  2093. return put_user((s->sctrl & SCTRL_P1SMB) ? 2 : 1, p);
  2094. case SOUND_PCM_READ_BITS:
  2095. return put_user((s->sctrl & SCTRL_P1SEB) ? 16 : 8, p);
  2096. case SOUND_PCM_WRITE_FILTER:
  2097. case SNDCTL_DSP_SETSYNCRO:
  2098. case SOUND_PCM_READ_FILTER:
  2099. return -EINVAL;
  2100. }
  2101. return mixdev_ioctl(s->codec, cmd, arg);
  2102. }
  2103. static int es1371_open_dac(struct inode *inode, struct file *file)
  2104. {
  2105. int minor = iminor(inode);
  2106. DECLARE_WAITQUEUE(wait, current);
  2107. unsigned long flags;
  2108. struct list_head *list;
  2109. struct es1371_state *s;
  2110. for (list = devs.next; ; list = list->next) {
  2111. if (list == &devs)
  2112. return -ENODEV;
  2113. s = list_entry(list, struct es1371_state, devs);
  2114. if (!((s->dev_dac ^ minor) & ~0xf))
  2115. break;
  2116. }
  2117. VALIDATE_STATE(s);
  2118. /* we allow opening with O_RDWR, most programs do it although they will only write */
  2119. #if 0
  2120. if (file->f_mode & FMODE_READ)
  2121. return -EPERM;
  2122. #endif
  2123. if (!(file->f_mode & FMODE_WRITE))
  2124. return -EINVAL;
  2125. file->private_data = s;
  2126. /* wait for device to become free */
  2127. down(&s->open_sem);
  2128. while (s->open_mode & FMODE_DAC) {
  2129. if (file->f_flags & O_NONBLOCK) {
  2130. up(&s->open_sem);
  2131. return -EBUSY;
  2132. }
  2133. add_wait_queue(&s->open_wait, &wait);
  2134. __set_current_state(TASK_INTERRUPTIBLE);
  2135. up(&s->open_sem);
  2136. schedule();
  2137. remove_wait_queue(&s->open_wait, &wait);
  2138. set_current_state(TASK_RUNNING);
  2139. if (signal_pending(current))
  2140. return -ERESTARTSYS;
  2141. down(&s->open_sem);
  2142. }
  2143. s->dma_dac1.ossfragshift = s->dma_dac1.ossmaxfrags = s->dma_dac1.subdivision = 0;
  2144. s->dma_dac1.enabled = 1;
  2145. set_dac1_rate(s, 8000);
  2146. spin_lock_irqsave(&s->lock, flags);
  2147. s->sctrl &= ~SCTRL_P1FMT;
  2148. if ((minor & 0xf) == SND_DEV_DSP16)
  2149. s->sctrl |= ES1371_FMT_S16_MONO << SCTRL_SH_P1FMT;
  2150. else
  2151. s->sctrl |= ES1371_FMT_U8_MONO << SCTRL_SH_P1FMT;
  2152. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  2153. spin_unlock_irqrestore(&s->lock, flags);
  2154. s->open_mode |= FMODE_DAC;
  2155. up(&s->open_sem);
  2156. return nonseekable_open(inode, file);
  2157. }
  2158. static int es1371_release_dac(struct inode *inode, struct file *file)
  2159. {
  2160. struct es1371_state *s = (struct es1371_state *)file->private_data;
  2161. VALIDATE_STATE(s);
  2162. lock_kernel();
  2163. drain_dac1(s, file->f_flags & O_NONBLOCK);
  2164. down(&s->open_sem);
  2165. stop_dac1(s);
  2166. dealloc_dmabuf(s, &s->dma_dac1);
  2167. s->open_mode &= ~FMODE_DAC;
  2168. up(&s->open_sem);
  2169. wake_up(&s->open_wait);
  2170. unlock_kernel();
  2171. return 0;
  2172. }
  2173. static /*const*/ struct file_operations es1371_dac_fops = {
  2174. .owner = THIS_MODULE,
  2175. .llseek = no_llseek,
  2176. .write = es1371_write_dac,
  2177. .poll = es1371_poll_dac,
  2178. .ioctl = es1371_ioctl_dac,
  2179. .mmap = es1371_mmap_dac,
  2180. .open = es1371_open_dac,
  2181. .release = es1371_release_dac,
  2182. };
  2183. /* --------------------------------------------------------------------- */
  2184. static ssize_t es1371_midi_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos)
  2185. {
  2186. struct es1371_state *s = (struct es1371_state *)file->private_data;
  2187. DECLARE_WAITQUEUE(wait, current);
  2188. ssize_t ret;
  2189. unsigned long flags;
  2190. unsigned ptr;
  2191. int cnt;
  2192. VALIDATE_STATE(s);
  2193. if (!access_ok(VERIFY_WRITE, buffer, count))
  2194. return -EFAULT;
  2195. if (count == 0)
  2196. return 0;
  2197. ret = 0;
  2198. add_wait_queue(&s->midi.iwait, &wait);
  2199. while (count > 0) {
  2200. spin_lock_irqsave(&s->lock, flags);
  2201. ptr = s->midi.ird;
  2202. cnt = MIDIINBUF - ptr;
  2203. if (s->midi.icnt < cnt)
  2204. cnt = s->midi.icnt;
  2205. if (cnt <= 0)
  2206. __set_current_state(TASK_INTERRUPTIBLE);
  2207. spin_unlock_irqrestore(&s->lock, flags);
  2208. if (cnt > count)
  2209. cnt = count;
  2210. if (cnt <= 0) {
  2211. if (file->f_flags & O_NONBLOCK) {
  2212. if (!ret)
  2213. ret = -EAGAIN;
  2214. break;
  2215. }
  2216. schedule();
  2217. if (signal_pending(current)) {
  2218. if (!ret)
  2219. ret = -ERESTARTSYS;
  2220. break;
  2221. }
  2222. continue;
  2223. }
  2224. if (copy_to_user(buffer, s->midi.ibuf + ptr, cnt)) {
  2225. if (!ret)
  2226. ret = -EFAULT;
  2227. break;
  2228. }
  2229. ptr = (ptr + cnt) % MIDIINBUF;
  2230. spin_lock_irqsave(&s->lock, flags);
  2231. s->midi.ird = ptr;
  2232. s->midi.icnt -= cnt;
  2233. spin_unlock_irqrestore(&s->lock, flags);
  2234. count -= cnt;
  2235. buffer += cnt;
  2236. ret += cnt;
  2237. break;
  2238. }
  2239. __set_current_state(TASK_RUNNING);
  2240. remove_wait_queue(&s->midi.iwait, &wait);
  2241. return ret;
  2242. }
  2243. static ssize_t es1371_midi_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
  2244. {
  2245. struct es1371_state *s = (struct es1371_state *)file->private_data;
  2246. DECLARE_WAITQUEUE(wait, current);
  2247. ssize_t ret;
  2248. unsigned long flags;
  2249. unsigned ptr;
  2250. int cnt;
  2251. VALIDATE_STATE(s);
  2252. if (!access_ok(VERIFY_READ, buffer, count))
  2253. return -EFAULT;
  2254. if (count == 0)
  2255. return 0;
  2256. ret = 0;
  2257. add_wait_queue(&s->midi.owait, &wait);
  2258. while (count > 0) {
  2259. spin_lock_irqsave(&s->lock, flags);
  2260. ptr = s->midi.owr;
  2261. cnt = MIDIOUTBUF - ptr;
  2262. if (s->midi.ocnt + cnt > MIDIOUTBUF)
  2263. cnt = MIDIOUTBUF - s->midi.ocnt;
  2264. if (cnt <= 0) {
  2265. __set_current_state(TASK_INTERRUPTIBLE);
  2266. es1371_handle_midi(s);
  2267. }
  2268. spin_unlock_irqrestore(&s->lock, flags);
  2269. if (cnt > count)
  2270. cnt = count;
  2271. if (cnt <= 0) {
  2272. if (file->f_flags & O_NONBLOCK) {
  2273. if (!ret)
  2274. ret = -EAGAIN;
  2275. break;
  2276. }
  2277. schedule();
  2278. if (signal_pending(current)) {
  2279. if (!ret)
  2280. ret = -ERESTARTSYS;
  2281. break;
  2282. }
  2283. continue;
  2284. }
  2285. if (copy_from_user(s->midi.obuf + ptr, buffer, cnt)) {
  2286. if (!ret)
  2287. ret = -EFAULT;
  2288. break;
  2289. }
  2290. ptr = (ptr + cnt) % MIDIOUTBUF;
  2291. spin_lock_irqsave(&s->lock, flags);
  2292. s->midi.owr = ptr;
  2293. s->midi.ocnt += cnt;
  2294. spin_unlock_irqrestore(&s->lock, flags);
  2295. count -= cnt;
  2296. buffer += cnt;
  2297. ret += cnt;
  2298. spin_lock_irqsave(&s->lock, flags);
  2299. es1371_handle_midi(s);
  2300. spin_unlock_irqrestore(&s->lock, flags);
  2301. }
  2302. __set_current_state(TASK_RUNNING);
  2303. remove_wait_queue(&s->midi.owait, &wait);
  2304. return ret;
  2305. }
  2306. /* No kernel lock - we have our own spinlock */
  2307. static unsigned int es1371_midi_poll(struct file *file, struct poll_table_struct *wait)
  2308. {
  2309. struct es1371_state *s = (struct es1371_state *)file->private_data;
  2310. unsigned long flags;
  2311. unsigned int mask = 0;
  2312. VALIDATE_STATE(s);
  2313. if (file->f_mode & FMODE_WRITE)
  2314. poll_wait(file, &s->midi.owait, wait);
  2315. if (file->f_mode & FMODE_READ)
  2316. poll_wait(file, &s->midi.iwait, wait);
  2317. spin_lock_irqsave(&s->lock, flags);
  2318. if (file->f_mode & FMODE_READ) {
  2319. if (s->midi.icnt > 0)
  2320. mask |= POLLIN | POLLRDNORM;
  2321. }
  2322. if (file->f_mode & FMODE_WRITE) {
  2323. if (s->midi.ocnt < MIDIOUTBUF)
  2324. mask |= POLLOUT | POLLWRNORM;
  2325. }
  2326. spin_unlock_irqrestore(&s->lock, flags);
  2327. return mask;
  2328. }
  2329. static int es1371_midi_open(struct inode *inode, struct file *file)
  2330. {
  2331. int minor = iminor(inode);
  2332. DECLARE_WAITQUEUE(wait, current);
  2333. unsigned long flags;
  2334. struct list_head *list;
  2335. struct es1371_state *s;
  2336. for (list = devs.next; ; list = list->next) {
  2337. if (list == &devs)
  2338. return -ENODEV;
  2339. s = list_entry(list, struct es1371_state, devs);
  2340. if (s->dev_midi == minor)
  2341. break;
  2342. }
  2343. VALIDATE_STATE(s);
  2344. file->private_data = s;
  2345. /* wait for device to become free */
  2346. down(&s->open_sem);
  2347. while (s->open_mode & (file->f_mode << FMODE_MIDI_SHIFT)) {
  2348. if (file->f_flags & O_NONBLOCK) {
  2349. up(&s->open_sem);
  2350. return -EBUSY;
  2351. }
  2352. add_wait_queue(&s->open_wait, &wait);
  2353. __set_current_state(TASK_INTERRUPTIBLE);
  2354. up(&s->open_sem);
  2355. schedule();
  2356. remove_wait_queue(&s->open_wait, &wait);
  2357. set_current_state(TASK_RUNNING);
  2358. if (signal_pending(current))
  2359. return -ERESTARTSYS;
  2360. down(&s->open_sem);
  2361. }
  2362. spin_lock_irqsave(&s->lock, flags);
  2363. if (!(s->open_mode & (FMODE_MIDI_READ | FMODE_MIDI_WRITE))) {
  2364. s->midi.ird = s->midi.iwr = s->midi.icnt = 0;
  2365. s->midi.ord = s->midi.owr = s->midi.ocnt = 0;
  2366. outb(UCTRL_CNTRL_SWR, s->io+ES1371_REG_UART_CONTROL);
  2367. outb(0, s->io+ES1371_REG_UART_CONTROL);
  2368. outb(0, s->io+ES1371_REG_UART_TEST);
  2369. }
  2370. if (file->f_mode & FMODE_READ) {
  2371. s->midi.ird = s->midi.iwr = s->midi.icnt = 0;
  2372. }
  2373. if (file->f_mode & FMODE_WRITE) {
  2374. s->midi.ord = s->midi.owr = s->midi.ocnt = 0;
  2375. }
  2376. s->ctrl |= CTRL_UART_EN;
  2377. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  2378. es1371_handle_midi(s);
  2379. spin_unlock_irqrestore(&s->lock, flags);
  2380. s->open_mode |= (file->f_mode << FMODE_MIDI_SHIFT) & (FMODE_MIDI_READ | FMODE_MIDI_WRITE);
  2381. up(&s->open_sem);
  2382. return nonseekable_open(inode, file);
  2383. }
  2384. static int es1371_midi_release(struct inode *inode, struct file *file)
  2385. {
  2386. struct es1371_state *s = (struct es1371_state *)file->private_data;
  2387. DECLARE_WAITQUEUE(wait, current);
  2388. unsigned long flags;
  2389. unsigned count, tmo;
  2390. VALIDATE_STATE(s);
  2391. lock_kernel();
  2392. if (file->f_mode & FMODE_WRITE) {
  2393. add_wait_queue(&s->midi.owait, &wait);
  2394. for (;;) {
  2395. __set_current_state(TASK_INTERRUPTIBLE);
  2396. spin_lock_irqsave(&s->lock, flags);
  2397. count = s->midi.ocnt;
  2398. spin_unlock_irqrestore(&s->lock, flags);
  2399. if (count <= 0)
  2400. break;
  2401. if (signal_pending(current))
  2402. break;
  2403. if (file->f_flags & O_NONBLOCK)
  2404. break;
  2405. tmo = (count * HZ) / 3100;
  2406. if (!schedule_timeout(tmo ? : 1) && tmo)
  2407. printk(KERN_DEBUG PFX "midi timed out??\n");
  2408. }
  2409. remove_wait_queue(&s->midi.owait, &wait);
  2410. set_current_state(TASK_RUNNING);
  2411. }
  2412. down(&s->open_sem);
  2413. s->open_mode &= ~((file->f_mode << FMODE_MIDI_SHIFT) & (FMODE_MIDI_READ|FMODE_MIDI_WRITE));
  2414. spin_lock_irqsave(&s->lock, flags);
  2415. if (!(s->open_mode & (FMODE_MIDI_READ | FMODE_MIDI_WRITE))) {
  2416. s->ctrl &= ~CTRL_UART_EN;
  2417. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  2418. }
  2419. spin_unlock_irqrestore(&s->lock, flags);
  2420. up(&s->open_sem);
  2421. wake_up(&s->open_wait);
  2422. unlock_kernel();
  2423. return 0;
  2424. }
  2425. static /*const*/ struct file_operations es1371_midi_fops = {
  2426. .owner = THIS_MODULE,
  2427. .llseek = no_llseek,
  2428. .read = es1371_midi_read,
  2429. .write = es1371_midi_write,
  2430. .poll = es1371_midi_poll,
  2431. .open = es1371_midi_open,
  2432. .release = es1371_midi_release,
  2433. };
  2434. /* --------------------------------------------------------------------- */
  2435. /*
  2436. * for debugging purposes, we'll create a proc device that dumps the
  2437. * CODEC chipstate
  2438. */
  2439. #ifdef ES1371_DEBUG
  2440. static int proc_es1371_dump (char *buf, char **start, off_t fpos, int length, int *eof, void *data)
  2441. {
  2442. struct es1371_state *s;
  2443. int cnt, len = 0;
  2444. if (list_empty(&devs))
  2445. return 0;
  2446. s = list_entry(devs.next, struct es1371_state, devs);
  2447. /* print out header */
  2448. len += sprintf(buf + len, "\t\tCreative ES137x Debug Dump-o-matic\n");
  2449. /* print out CODEC state */
  2450. len += sprintf (buf + len, "AC97 CODEC state\n");
  2451. for (cnt=0; cnt <= 0x7e; cnt = cnt +2)
  2452. len+= sprintf (buf + len, "reg:0x%02x val:0x%04x\n", cnt, rdcodec(s->codec, cnt));
  2453. if (fpos >=len){
  2454. *start = buf;
  2455. *eof =1;
  2456. return 0;
  2457. }
  2458. *start = buf + fpos;
  2459. if ((len -= fpos) > length)
  2460. return length;
  2461. *eof =1;
  2462. return len;
  2463. }
  2464. #endif /* ES1371_DEBUG */
  2465. /* --------------------------------------------------------------------- */
  2466. /* maximum number of devices; only used for command line params */
  2467. #define NR_DEVICE 5
  2468. static int spdif[NR_DEVICE];
  2469. static int nomix[NR_DEVICE];
  2470. static int amplifier[NR_DEVICE];
  2471. static unsigned int devindex;
  2472. module_param_array(spdif, bool, NULL, 0);
  2473. MODULE_PARM_DESC(spdif, "if 1 the output is in S/PDIF digital mode");
  2474. module_param_array(nomix, bool, NULL, 0);
  2475. MODULE_PARM_DESC(nomix, "if 1 no analog audio is mixed to the digital output");
  2476. module_param_array(amplifier, bool, NULL, 0);
  2477. MODULE_PARM_DESC(amplifier, "Set to 1 if the machine needs the amp control enabling (many laptops)");
  2478. MODULE_AUTHOR("Thomas M. Sailer, sailer@ife.ee.ethz.ch, hb9jnx@hb9w.che.eu");
  2479. MODULE_DESCRIPTION("ES1371 AudioPCI97 Driver");
  2480. MODULE_LICENSE("GPL");
  2481. /* --------------------------------------------------------------------- */
  2482. static struct initvol {
  2483. int mixch;
  2484. int vol;
  2485. } initvol[] __devinitdata = {
  2486. { SOUND_MIXER_WRITE_LINE, 0x4040 },
  2487. { SOUND_MIXER_WRITE_CD, 0x4040 },
  2488. { MIXER_WRITE(SOUND_MIXER_VIDEO), 0x4040 },
  2489. { SOUND_MIXER_WRITE_LINE1, 0x4040 },
  2490. { SOUND_MIXER_WRITE_PCM, 0x4040 },
  2491. { SOUND_MIXER_WRITE_VOLUME, 0x4040 },
  2492. { MIXER_WRITE(SOUND_MIXER_PHONEOUT), 0x4040 },
  2493. { SOUND_MIXER_WRITE_OGAIN, 0x4040 },
  2494. { MIXER_WRITE(SOUND_MIXER_PHONEIN), 0x4040 },
  2495. { SOUND_MIXER_WRITE_SPEAKER, 0x4040 },
  2496. { SOUND_MIXER_WRITE_MIC, 0x4040 },
  2497. { SOUND_MIXER_WRITE_RECLEV, 0x4040 },
  2498. { SOUND_MIXER_WRITE_IGAIN, 0x4040 }
  2499. };
  2500. static struct
  2501. {
  2502. short svid, sdid;
  2503. } amplifier_needed[] =
  2504. {
  2505. { 0x107B, 0x2150 }, /* Gateway Solo 2150 */
  2506. { 0x13BD, 0x100C }, /* Mebius PC-MJ100V */
  2507. { 0x1102, 0x5938 }, /* Targa Xtender 300 */
  2508. { 0x1102, 0x8938 }, /* IPC notebook */
  2509. { PCI_ANY_ID, PCI_ANY_ID }
  2510. };
  2511. static int __devinit es1371_probe(struct pci_dev *pcidev, const struct pci_device_id *pciid)
  2512. {
  2513. struct es1371_state *s;
  2514. struct gameport *gp;
  2515. mm_segment_t fs;
  2516. int i, gpio, val, res = -1;
  2517. int idx;
  2518. unsigned long tmo;
  2519. signed long tmo2;
  2520. unsigned int cssr;
  2521. if ((res=pci_enable_device(pcidev)))
  2522. return res;
  2523. if (!(pci_resource_flags(pcidev, 0) & IORESOURCE_IO))
  2524. return -ENODEV;
  2525. if (pcidev->irq == 0)
  2526. return -ENODEV;
  2527. i = pci_set_dma_mask(pcidev, DMA_32BIT_MASK);
  2528. if (i) {
  2529. printk(KERN_WARNING "es1371: architecture does not support 32bit PCI busmaster DMA\n");
  2530. return i;
  2531. }
  2532. if (!(s = kmalloc(sizeof(struct es1371_state), GFP_KERNEL))) {
  2533. printk(KERN_WARNING PFX "out of memory\n");
  2534. return -ENOMEM;
  2535. }
  2536. memset(s, 0, sizeof(struct es1371_state));
  2537. s->codec = ac97_alloc_codec();
  2538. if(s->codec == NULL)
  2539. goto err_codec;
  2540. init_waitqueue_head(&s->dma_adc.wait);
  2541. init_waitqueue_head(&s->dma_dac1.wait);
  2542. init_waitqueue_head(&s->dma_dac2.wait);
  2543. init_waitqueue_head(&s->open_wait);
  2544. init_waitqueue_head(&s->midi.iwait);
  2545. init_waitqueue_head(&s->midi.owait);
  2546. init_MUTEX(&s->open_sem);
  2547. spin_lock_init(&s->lock);
  2548. s->magic = ES1371_MAGIC;
  2549. s->dev = pcidev;
  2550. s->io = pci_resource_start(pcidev, 0);
  2551. s->irq = pcidev->irq;
  2552. s->vendor = pcidev->vendor;
  2553. s->device = pcidev->device;
  2554. pci_read_config_byte(pcidev, PCI_REVISION_ID, &s->rev);
  2555. s->codec->private_data = s;
  2556. s->codec->id = 0;
  2557. s->codec->codec_read = rdcodec;
  2558. s->codec->codec_write = wrcodec;
  2559. printk(KERN_INFO PFX "found chip, vendor id 0x%04x device id 0x%04x revision 0x%02x\n",
  2560. s->vendor, s->device, s->rev);
  2561. if (!request_region(s->io, ES1371_EXTENT, "es1371")) {
  2562. printk(KERN_ERR PFX "io ports %#lx-%#lx in use\n", s->io, s->io+ES1371_EXTENT-1);
  2563. res = -EBUSY;
  2564. goto err_region;
  2565. }
  2566. if ((res=request_irq(s->irq, es1371_interrupt, SA_SHIRQ, "es1371",s))) {
  2567. printk(KERN_ERR PFX "irq %u in use\n", s->irq);
  2568. goto err_irq;
  2569. }
  2570. printk(KERN_INFO PFX "found es1371 rev %d at io %#lx irq %u\n",
  2571. s->rev, s->io, s->irq);
  2572. /* register devices */
  2573. if ((res=(s->dev_audio = register_sound_dsp(&es1371_audio_fops,-1)))<0)
  2574. goto err_dev1;
  2575. if ((res=(s->codec->dev_mixer = register_sound_mixer(&es1371_mixer_fops, -1))) < 0)
  2576. goto err_dev2;
  2577. if ((res=(s->dev_dac = register_sound_dsp(&es1371_dac_fops, -1))) < 0)
  2578. goto err_dev3;
  2579. if ((res=(s->dev_midi = register_sound_midi(&es1371_midi_fops, -1)))<0 )
  2580. goto err_dev4;
  2581. #ifdef ES1371_DEBUG
  2582. /* initialize the debug proc device */
  2583. s->ps = create_proc_read_entry("es1371",0,NULL,proc_es1371_dump,NULL);
  2584. #endif /* ES1371_DEBUG */
  2585. /* initialize codec registers */
  2586. s->ctrl = 0;
  2587. /* Check amplifier requirements */
  2588. if (amplifier[devindex])
  2589. s->ctrl |= CTRL_GPIO_OUT0;
  2590. else for(idx = 0; amplifier_needed[idx].svid != PCI_ANY_ID; idx++)
  2591. {
  2592. if(pcidev->subsystem_vendor == amplifier_needed[idx].svid &&
  2593. pcidev->subsystem_device == amplifier_needed[idx].sdid)
  2594. {
  2595. s->ctrl |= CTRL_GPIO_OUT0; /* turn internal amplifier on */
  2596. printk(KERN_INFO PFX "Enabling internal amplifier.\n");
  2597. }
  2598. }
  2599. for (gpio = 0x218; gpio >= 0x200; gpio -= 0x08)
  2600. if (request_region(gpio, JOY_EXTENT, "es1371"))
  2601. break;
  2602. if (gpio < 0x200) {
  2603. printk(KERN_ERR PFX "no free joystick address found\n");
  2604. } else if (!(s->gameport = gp = gameport_allocate_port())) {
  2605. printk(KERN_ERR PFX "can not allocate memory for gameport\n");
  2606. release_region(gpio, JOY_EXTENT);
  2607. } else {
  2608. gameport_set_name(gp, "ESS1371 Gameport");
  2609. gameport_set_phys(gp, "isa%04x/gameport0", gpio);
  2610. gp->dev.parent = &s->dev->dev;
  2611. gp->io = gpio;
  2612. s->ctrl |= CTRL_JYSTK_EN | (((gpio >> 3) & CTRL_JOY_MASK) << CTRL_JOY_SHIFT);
  2613. }
  2614. s->sctrl = 0;
  2615. cssr = 0;
  2616. s->spdif_volume = -1;
  2617. /* check to see if s/pdif mode is being requested */
  2618. if (spdif[devindex]) {
  2619. if (s->rev >= 4) {
  2620. printk(KERN_INFO PFX "enabling S/PDIF output\n");
  2621. s->spdif_volume = 0;
  2622. cssr |= STAT_EN_SPDIF;
  2623. s->ctrl |= CTRL_SPDIFEN_B;
  2624. if (nomix[devindex]) /* don't mix analog inputs to s/pdif output */
  2625. s->ctrl |= CTRL_RECEN_B;
  2626. } else {
  2627. printk(KERN_ERR PFX "revision %d does not support S/PDIF\n", s->rev);
  2628. }
  2629. }
  2630. /* initialize the chips */
  2631. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  2632. outl(s->sctrl, s->io+ES1371_REG_SERIAL_CONTROL);
  2633. outl(LEGACY_JFAST, s->io+ES1371_REG_LEGACY);
  2634. pci_set_master(pcidev); /* enable bus mastering */
  2635. /* if we are a 5880 turn on the AC97 */
  2636. if (s->vendor == PCI_VENDOR_ID_ENSONIQ &&
  2637. ((s->device == PCI_DEVICE_ID_ENSONIQ_CT5880 && s->rev >= CT5880REV_CT5880_C) ||
  2638. (s->device == PCI_DEVICE_ID_ENSONIQ_ES1371 && s->rev == ES1371REV_CT5880_A) ||
  2639. (s->device == PCI_DEVICE_ID_ENSONIQ_ES1371 && s->rev == ES1371REV_ES1373_8))) {
  2640. cssr |= CSTAT_5880_AC97_RST;
  2641. outl(cssr, s->io+ES1371_REG_STATUS);
  2642. /* need to delay around 20ms(bleech) to give
  2643. some CODECs enough time to wakeup */
  2644. tmo = jiffies + (HZ / 50) + 1;
  2645. for (;;) {
  2646. tmo2 = tmo - jiffies;
  2647. if (tmo2 <= 0)
  2648. break;
  2649. schedule_timeout(tmo2);
  2650. }
  2651. }
  2652. /* AC97 warm reset to start the bitclk */
  2653. outl(s->ctrl | CTRL_SYNCRES, s->io+ES1371_REG_CONTROL);
  2654. udelay(2);
  2655. outl(s->ctrl, s->io+ES1371_REG_CONTROL);
  2656. /* init the sample rate converter */
  2657. src_init(s);
  2658. /* codec init */
  2659. if (!ac97_probe_codec(s->codec)) {
  2660. res = -ENODEV;
  2661. goto err_gp;
  2662. }
  2663. /* set default values */
  2664. fs = get_fs();
  2665. set_fs(KERNEL_DS);
  2666. val = SOUND_MASK_LINE;
  2667. mixdev_ioctl(s->codec, SOUND_MIXER_WRITE_RECSRC, (unsigned long)&val);
  2668. for (i = 0; i < sizeof(initvol)/sizeof(initvol[0]); i++) {
  2669. val = initvol[i].vol;
  2670. mixdev_ioctl(s->codec, initvol[i].mixch, (unsigned long)&val);
  2671. }
  2672. /* mute master and PCM when in S/PDIF mode */
  2673. if (s->spdif_volume != -1) {
  2674. val = 0x0000;
  2675. s->codec->mixer_ioctl(s->codec, SOUND_MIXER_WRITE_VOLUME, (unsigned long)&val);
  2676. s->codec->mixer_ioctl(s->codec, SOUND_MIXER_WRITE_PCM, (unsigned long)&val);
  2677. }
  2678. set_fs(fs);
  2679. /* turn on S/PDIF output driver if requested */
  2680. outl(cssr, s->io+ES1371_REG_STATUS);
  2681. /* register gameport */
  2682. if (s->gameport)
  2683. gameport_register_port(s->gameport);
  2684. /* store it in the driver field */
  2685. pci_set_drvdata(pcidev, s);
  2686. /* put it into driver list */
  2687. list_add_tail(&s->devs, &devs);
  2688. /* increment devindex */
  2689. if (devindex < NR_DEVICE-1)
  2690. devindex++;
  2691. return 0;
  2692. err_gp:
  2693. if (s->gameport) {
  2694. release_region(s->gameport->io, JOY_EXTENT);
  2695. gameport_free_port(s->gameport);
  2696. }
  2697. #ifdef ES1371_DEBUG
  2698. if (s->ps)
  2699. remove_proc_entry("es1371", NULL);
  2700. #endif
  2701. unregister_sound_midi(s->dev_midi);
  2702. err_dev4:
  2703. unregister_sound_dsp(s->dev_dac);
  2704. err_dev3:
  2705. unregister_sound_mixer(s->codec->dev_mixer);
  2706. err_dev2:
  2707. unregister_sound_dsp(s->dev_audio);
  2708. err_dev1:
  2709. printk(KERN_ERR PFX "cannot register misc device\n");
  2710. free_irq(s->irq, s);
  2711. err_irq:
  2712. release_region(s->io, ES1371_EXTENT);
  2713. err_region:
  2714. err_codec:
  2715. ac97_release_codec(s->codec);
  2716. kfree(s);
  2717. return res;
  2718. }
  2719. static void __devexit es1371_remove(struct pci_dev *dev)
  2720. {
  2721. struct es1371_state *s = pci_get_drvdata(dev);
  2722. if (!s)
  2723. return;
  2724. list_del(&s->devs);
  2725. #ifdef ES1371_DEBUG
  2726. if (s->ps)
  2727. remove_proc_entry("es1371", NULL);
  2728. #endif /* ES1371_DEBUG */
  2729. outl(0, s->io+ES1371_REG_CONTROL); /* switch everything off */
  2730. outl(0, s->io+ES1371_REG_SERIAL_CONTROL); /* clear serial interrupts */
  2731. synchronize_irq(s->irq);
  2732. free_irq(s->irq, s);
  2733. if (s->gameport) {
  2734. int gpio = s->gameport->io;
  2735. gameport_unregister_port(s->gameport);
  2736. release_region(gpio, JOY_EXTENT);
  2737. }
  2738. release_region(s->io, ES1371_EXTENT);
  2739. unregister_sound_dsp(s->dev_audio);
  2740. unregister_sound_mixer(s->codec->dev_mixer);
  2741. unregister_sound_dsp(s->dev_dac);
  2742. unregister_sound_midi(s->dev_midi);
  2743. ac97_release_codec(s->codec);
  2744. kfree(s);
  2745. pci_set_drvdata(dev, NULL);
  2746. }
  2747. static struct pci_device_id id_table[] = {
  2748. { PCI_VENDOR_ID_ENSONIQ, PCI_DEVICE_ID_ENSONIQ_ES1371, PCI_ANY_ID, PCI_ANY_ID, 0, 0 },
  2749. { PCI_VENDOR_ID_ENSONIQ, PCI_DEVICE_ID_ENSONIQ_CT5880, PCI_ANY_ID, PCI_ANY_ID, 0, 0 },
  2750. { PCI_VENDOR_ID_ECTIVA, PCI_DEVICE_ID_ECTIVA_EV1938, PCI_ANY_ID, PCI_ANY_ID, 0, 0 },
  2751. { 0, }
  2752. };
  2753. MODULE_DEVICE_TABLE(pci, id_table);
  2754. static struct pci_driver es1371_driver = {
  2755. .name = "es1371",
  2756. .id_table = id_table,
  2757. .probe = es1371_probe,
  2758. .remove = __devexit_p(es1371_remove),
  2759. };
  2760. static int __init init_es1371(void)
  2761. {
  2762. printk(KERN_INFO PFX "version v0.32 time " __TIME__ " " __DATE__ "\n");
  2763. return pci_module_init(&es1371_driver);
  2764. }
  2765. static void __exit cleanup_es1371(void)
  2766. {
  2767. printk(KERN_INFO PFX "unloading\n");
  2768. pci_unregister_driver(&es1371_driver);
  2769. }
  2770. module_init(init_es1371);
  2771. module_exit(cleanup_es1371);
  2772. /* --------------------------------------------------------------------- */
  2773. #ifndef MODULE
  2774. /* format is: es1371=[spdif,[nomix,[amplifier]]] */
  2775. static int __init es1371_setup(char *str)
  2776. {
  2777. static unsigned __initdata nr_dev = 0;
  2778. if (nr_dev >= NR_DEVICE)
  2779. return 0;
  2780. (void)
  2781. ((get_option(&str, &spdif[nr_dev]) == 2)
  2782. && (get_option(&str, &nomix[nr_dev]) == 2)
  2783. && (get_option(&str, &amplifier[nr_dev])));
  2784. nr_dev++;
  2785. return 1;
  2786. }
  2787. __setup("es1371=", es1371_setup);
  2788. #endif /* MODULE */