es1371.c 92 KB

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