maestro3.c 86 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973
  1. /*****************************************************************************
  2. *
  3. * ESS Maestro3/Allegro driver for Linux 2.4.x
  4. *
  5. * This program is free software; you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License as published by
  7. * the Free Software Foundation; either version 2 of the License, or
  8. * (at your option) any later version.
  9. *
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License
  16. * along with this program; if not, write to the Free Software
  17. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  18. *
  19. * (c) Copyright 2000 Zach Brown <zab@zabbo.net>
  20. *
  21. * I need to thank many people for helping make this driver happen.
  22. * As always, Eric Brombaugh was a hacking machine and killed many bugs
  23. * that I was too dumb to notice. Howard Kim at ESS provided reference boards
  24. * and as much docs as he could. Todd and Mick at Dell tested snapshots on
  25. * an army of laptops. msw and deviant at Red Hat also humoured me by hanging
  26. * their laptops every few hours in the name of science.
  27. *
  28. * Shouts go out to Mike "DJ XPCom" Ang.
  29. *
  30. * History
  31. * v1.23 - Jun 5 2002 - Michael Olson <olson@cs.odu.edu>
  32. * added a module option to allow selection of GPIO pin number
  33. * for external amp
  34. * v1.22 - Feb 28 2001 - Zach Brown <zab@zabbo.net>
  35. * allocate mem at insmod/setup, rather than open
  36. * limit pci dma addresses to 28bit, thanks guys.
  37. * v1.21 - Feb 04 2001 - Zach Brown <zab@zabbo.net>
  38. * fix up really dumb notifier -> suspend oops
  39. * v1.20 - Jan 30 2001 - Zach Brown <zab@zabbo.net>
  40. * get rid of pm callback and use pci_dev suspend/resume instead
  41. * m3_probe cleanups, including pm oops think-o
  42. * v1.10 - Jan 6 2001 - Zach Brown <zab@zabbo.net>
  43. * revert to lame remap_page_range mmap() just to make it work
  44. * record mmap fixed.
  45. * fix up incredibly broken open/release resource management
  46. * duh. fix record format setting.
  47. * add SMP locking and cleanup formatting here and there
  48. * v1.00 - Dec 16 2000 - Zach Brown <zab@zabbo.net>
  49. * port to sexy 2.4 interfaces
  50. * properly align instance allocations so recording works
  51. * clean up function namespace a little :/
  52. * update PCI IDs based on mail from ESS
  53. * arbitrarily bump version number to show its 2.4 now,
  54. * 2.2 will stay 0., oss_audio port gets 2.
  55. * v0.03 - Nov 05 2000 - Zach Brown <zab@zabbo.net>
  56. * disable recording but allow dsp to be opened read
  57. * pull out most silly compat defines
  58. * v0.02 - Nov 04 2000 - Zach Brown <zab@zabbo.net>
  59. * changed clocking setup for m3, slowdown fixed.
  60. * codec reset is hopefully reliable now
  61. * rudimentary apm/power management makes suspend/resume work
  62. * v0.01 - Oct 31 2000 - Zach Brown <zab@zabbo.net>
  63. * first release
  64. * v0.00 - Sep 09 2000 - Zach Brown <zab@zabbo.net>
  65. * first pass derivation from maestro.c
  66. *
  67. * TODO
  68. * in/out allocated contiguously so fullduplex mmap will work?
  69. * no beep on init (mute)
  70. * resetup msrc data memory if freq changes?
  71. *
  72. * --
  73. *
  74. * Allow me to ramble a bit about the m3 architecture. The core of the
  75. * chip is the 'assp', the custom ESS dsp that runs the show. It has
  76. * a small amount of code and data ram. ESS drops binary dsp code images
  77. * on our heads, but we don't get to see specs on the dsp.
  78. *
  79. * The constant piece of code on the dsp is the 'kernel'. It also has a
  80. * chunk of the dsp memory that is statically set aside for its control
  81. * info. This is the KDATA defines in maestro3.h. Part of its core
  82. * data is a list of code addresses that point to the pieces of DSP code
  83. * that it should walk through in its loop. These other pieces of code
  84. * do the real work. The kernel presumably jumps into each of them in turn.
  85. * These code images tend to have their own data area, and one can have
  86. * multiple data areas representing different states for each of the 'client
  87. * instance' code portions. There is generally a list in the kernel data
  88. * that points to the data instances for a given piece of code.
  89. *
  90. * We've only been given the binary image for the 'minisrc', mini sample
  91. * rate converter. This is rather annoying because it limits the work
  92. * we can do on the dsp, but it also greatly simplifies the job of managing
  93. * dsp data memory for the code and data for our playing streams :). We
  94. * statically allocate the minisrc code into a region we 'know' to be free
  95. * based on the map of the binary kernel image we're loading. We also
  96. * statically allocate the data areas for the maximum number of pcm streams
  97. * we can be dealing with. This max is set by the length of the static list
  98. * in the kernel data that records the number of minisrc data regions we
  99. * can have. Thats right, all software dsp mixing with static code list
  100. * limits. Rock.
  101. *
  102. * How sound goes in and out is still a relative mystery. It appears
  103. * that the dsp has the ability to get input and output through various
  104. * 'connections'. To do IO from or to a connection, you put the address
  105. * of the minisrc client area in the static kernel data lists for that
  106. * input or output. so for pcm -> dsp -> mixer, we put the minisrc data
  107. * instance in the DMA list and also in the list for the mixer. I guess
  108. * it Just Knows which is in/out, and we give some dma control info that
  109. * helps. There are all sorts of cool inputs/outputs that it seems we can't
  110. * use without dsp code images that know how to use them.
  111. *
  112. * So at init time we preload all the memory allocation stuff and set some
  113. * system wide parameters. When we really get a sound to play we build
  114. * up its minisrc header (stream parameters, buffer addresses, input/output
  115. * settings). Then we throw its header on the various lists. We also
  116. * tickle some KDATA settings that ask the assp to raise clock interrupts
  117. * and do some amount of software mixing before handing data to the ac97.
  118. *
  119. * Sorry for the vague details. Feel free to ask Eric or myself if you
  120. * happen to be trying to use this driver elsewhere. Please accept my
  121. * apologies for the quality of the OSS support code, its passed through
  122. * too many hands now and desperately wants to be rethought.
  123. */
  124. /*****************************************************************************/
  125. #include <linux/config.h>
  126. #include <linux/module.h>
  127. #include <linux/kernel.h>
  128. #include <linux/string.h>
  129. #include <linux/ctype.h>
  130. #include <linux/ioport.h>
  131. #include <linux/sched.h>
  132. #include <linux/delay.h>
  133. #include <linux/sound.h>
  134. #include <linux/slab.h>
  135. #include <linux/soundcard.h>
  136. #include <linux/pci.h>
  137. #include <linux/vmalloc.h>
  138. #include <linux/init.h>
  139. #include <linux/interrupt.h>
  140. #include <linux/poll.h>
  141. #include <linux/reboot.h>
  142. #include <linux/spinlock.h>
  143. #include <linux/ac97_codec.h>
  144. #include <linux/wait.h>
  145. #include <asm/io.h>
  146. #include <asm/dma.h>
  147. #include <asm/uaccess.h>
  148. #include "maestro3.h"
  149. #define M_DEBUG 1
  150. #define DRIVER_VERSION "1.23"
  151. #define M3_MODULE_NAME "maestro3"
  152. #define PFX M3_MODULE_NAME ": "
  153. #define M3_STATE_MAGIC 0x734d724d
  154. #define M3_CARD_MAGIC 0x646e6f50
  155. #define ESS_FMT_STEREO 0x01
  156. #define ESS_FMT_16BIT 0x02
  157. #define ESS_FMT_MASK 0x03
  158. #define ESS_DAC_SHIFT 0
  159. #define ESS_ADC_SHIFT 4
  160. #define DAC_RUNNING 1
  161. #define ADC_RUNNING 2
  162. #define SND_DEV_DSP16 5
  163. #ifdef M_DEBUG
  164. static int debug;
  165. #define DPMOD 1 /* per module load */
  166. #define DPSTR 2 /* per 'stream' */
  167. #define DPSYS 3 /* per syscall */
  168. #define DPCRAP 4 /* stuff the user shouldn't see unless they're really debuggin */
  169. #define DPINT 5 /* per interrupt, LOTS */
  170. #define DPRINTK(DP, args...) {if (debug >= (DP)) printk(KERN_DEBUG PFX args);}
  171. #else
  172. #define DPRINTK(x)
  173. #endif
  174. struct m3_list {
  175. int curlen;
  176. u16 mem_addr;
  177. int max;
  178. };
  179. static int external_amp = 1;
  180. static int gpio_pin = -1;
  181. struct m3_state {
  182. unsigned int magic;
  183. struct m3_card *card;
  184. unsigned char fmt, enable;
  185. int index;
  186. /* this locks around the oss state in the driver */
  187. /* no, this lock is removed - only use card->lock */
  188. /* otherwise: against what are you protecting on SMP
  189. when irqhandler uses s->lock
  190. and m3_assp_read uses card->lock ?
  191. */
  192. struct semaphore open_sem;
  193. wait_queue_head_t open_wait;
  194. mode_t open_mode;
  195. int dev_audio;
  196. struct assp_instance {
  197. u16 code, data;
  198. } dac_inst, adc_inst;
  199. /* should be in dmabuf */
  200. unsigned int rateadc, ratedac;
  201. struct dmabuf {
  202. void *rawbuf;
  203. unsigned buforder;
  204. unsigned numfrag;
  205. unsigned fragshift;
  206. unsigned hwptr, swptr;
  207. unsigned total_bytes;
  208. int count;
  209. unsigned error; /* over/underrun */
  210. wait_queue_head_t wait;
  211. /* redundant, but makes calculations easier */
  212. unsigned fragsize;
  213. unsigned dmasize;
  214. unsigned fragsamples;
  215. /* OSS stuff */
  216. unsigned mapped:1;
  217. unsigned ready:1;
  218. unsigned endcleared:1;
  219. unsigned ossfragshift;
  220. int ossmaxfrags;
  221. unsigned subdivision;
  222. /* new in m3 */
  223. int mixer_index, dma_index, msrc_index, adc1_index;
  224. int in_lists;
  225. /* 2.4.. */
  226. dma_addr_t handle;
  227. } dma_dac, dma_adc;
  228. };
  229. struct m3_card {
  230. unsigned int magic;
  231. struct m3_card *next;
  232. struct ac97_codec *ac97;
  233. spinlock_t ac97_lock;
  234. int card_type;
  235. #define NR_DSPS 1
  236. #define MAX_DSPS NR_DSPS
  237. struct m3_state channels[MAX_DSPS];
  238. /* this locks around the physical registers on the card */
  239. spinlock_t lock;
  240. /* hardware resources */
  241. struct pci_dev *pcidev;
  242. u32 iobase;
  243. u32 irq;
  244. int dacs_active;
  245. int timer_users;
  246. struct m3_list msrc_list,
  247. mixer_list,
  248. adc1_list,
  249. dma_list;
  250. /* for storing reset state..*/
  251. u8 reset_state;
  252. u16 *suspend_mem;
  253. int in_suspend;
  254. wait_queue_head_t suspend_queue;
  255. };
  256. /*
  257. * an arbitrary volume we set the internal
  258. * volume settings to so that the ac97 volume
  259. * range is a little less insane. 0x7fff is
  260. * max.
  261. */
  262. #define ARB_VOLUME ( 0x6800 )
  263. static const unsigned sample_shift[] = { 0, 1, 1, 2 };
  264. enum {
  265. ESS_ALLEGRO,
  266. ESS_MAESTRO3,
  267. /*
  268. * a maestro3 with 'hardware strapping', only
  269. * found inside ESS?
  270. */
  271. ESS_MAESTRO3HW,
  272. };
  273. static char *card_names[] = {
  274. [ESS_ALLEGRO] = "Allegro",
  275. [ESS_MAESTRO3] = "Maestro3(i)",
  276. [ESS_MAESTRO3HW] = "Maestro3(i)hw"
  277. };
  278. #ifndef PCI_VENDOR_ESS
  279. #define PCI_VENDOR_ESS 0x125D
  280. #endif
  281. #define M3_DEVICE(DEV, TYPE) \
  282. { \
  283. .vendor = PCI_VENDOR_ESS, \
  284. .device = DEV, \
  285. .subvendor = PCI_ANY_ID, \
  286. .subdevice = PCI_ANY_ID, \
  287. .class = PCI_CLASS_MULTIMEDIA_AUDIO << 8, \
  288. .class_mask = 0xffff << 8, \
  289. .driver_data = TYPE, \
  290. }
  291. static struct pci_device_id m3_id_table[] = {
  292. M3_DEVICE(0x1988, ESS_ALLEGRO),
  293. M3_DEVICE(0x1998, ESS_MAESTRO3),
  294. M3_DEVICE(0x199a, ESS_MAESTRO3HW),
  295. {0,}
  296. };
  297. MODULE_DEVICE_TABLE (pci, m3_id_table);
  298. /*
  299. * reports seem to indicate that the m3 is limited
  300. * to 28bit bus addresses. aaaargggh...
  301. */
  302. #define M3_PCI_DMA_MASK 0x0fffffff
  303. static unsigned
  304. ld2(unsigned int x)
  305. {
  306. unsigned r = 0;
  307. if (x >= 0x10000) {
  308. x >>= 16;
  309. r += 16;
  310. }
  311. if (x >= 0x100) {
  312. x >>= 8;
  313. r += 8;
  314. }
  315. if (x >= 0x10) {
  316. x >>= 4;
  317. r += 4;
  318. }
  319. if (x >= 4) {
  320. x >>= 2;
  321. r += 2;
  322. }
  323. if (x >= 2)
  324. r++;
  325. return r;
  326. }
  327. static struct m3_card *devs;
  328. /*
  329. * I'm not very good at laying out functions in a file :)
  330. */
  331. static int m3_notifier(struct notifier_block *nb, unsigned long event, void *buf);
  332. static int m3_suspend(struct pci_dev *pci_dev, pm_message_t state);
  333. static void check_suspend(struct m3_card *card);
  334. static struct notifier_block m3_reboot_nb = {
  335. .notifier_call = m3_notifier,
  336. };
  337. static void m3_outw(struct m3_card *card,
  338. u16 value, unsigned long reg)
  339. {
  340. check_suspend(card);
  341. outw(value, card->iobase + reg);
  342. }
  343. static u16 m3_inw(struct m3_card *card, unsigned long reg)
  344. {
  345. check_suspend(card);
  346. return inw(card->iobase + reg);
  347. }
  348. static void m3_outb(struct m3_card *card,
  349. u8 value, unsigned long reg)
  350. {
  351. check_suspend(card);
  352. outb(value, card->iobase + reg);
  353. }
  354. static u8 m3_inb(struct m3_card *card, unsigned long reg)
  355. {
  356. check_suspend(card);
  357. return inb(card->iobase + reg);
  358. }
  359. /*
  360. * access 16bit words to the code or data regions of the dsp's memory.
  361. * index addresses 16bit words.
  362. */
  363. static u16 __m3_assp_read(struct m3_card *card, u16 region, u16 index)
  364. {
  365. m3_outw(card, region & MEMTYPE_MASK, DSP_PORT_MEMORY_TYPE);
  366. m3_outw(card, index, DSP_PORT_MEMORY_INDEX);
  367. return m3_inw(card, DSP_PORT_MEMORY_DATA);
  368. }
  369. static u16 m3_assp_read(struct m3_card *card, u16 region, u16 index)
  370. {
  371. unsigned long flags;
  372. u16 ret;
  373. spin_lock_irqsave(&(card->lock), flags);
  374. ret = __m3_assp_read(card, region, index);
  375. spin_unlock_irqrestore(&(card->lock), flags);
  376. return ret;
  377. }
  378. static void __m3_assp_write(struct m3_card *card,
  379. u16 region, u16 index, u16 data)
  380. {
  381. m3_outw(card, region & MEMTYPE_MASK, DSP_PORT_MEMORY_TYPE);
  382. m3_outw(card, index, DSP_PORT_MEMORY_INDEX);
  383. m3_outw(card, data, DSP_PORT_MEMORY_DATA);
  384. }
  385. static void m3_assp_write(struct m3_card *card,
  386. u16 region, u16 index, u16 data)
  387. {
  388. unsigned long flags;
  389. spin_lock_irqsave(&(card->lock), flags);
  390. __m3_assp_write(card, region, index, data);
  391. spin_unlock_irqrestore(&(card->lock), flags);
  392. }
  393. static void m3_assp_halt(struct m3_card *card)
  394. {
  395. card->reset_state = m3_inb(card, DSP_PORT_CONTROL_REG_B) & ~REGB_STOP_CLOCK;
  396. mdelay(10);
  397. m3_outb(card, card->reset_state & ~REGB_ENABLE_RESET, DSP_PORT_CONTROL_REG_B);
  398. }
  399. static void m3_assp_continue(struct m3_card *card)
  400. {
  401. m3_outb(card, card->reset_state | REGB_ENABLE_RESET, DSP_PORT_CONTROL_REG_B);
  402. }
  403. /*
  404. * This makes me sad. the maestro3 has lists
  405. * internally that must be packed.. 0 terminates,
  406. * apparently, or maybe all unused entries have
  407. * to be 0, the lists have static lengths set
  408. * by the binary code images.
  409. */
  410. static int m3_add_list(struct m3_card *card,
  411. struct m3_list *list, u16 val)
  412. {
  413. DPRINTK(DPSTR, "adding val 0x%x to list 0x%p at pos %d\n",
  414. val, list, list->curlen);
  415. m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  416. list->mem_addr + list->curlen,
  417. val);
  418. return list->curlen++;
  419. }
  420. static void m3_remove_list(struct m3_card *card,
  421. struct m3_list *list, int index)
  422. {
  423. u16 val;
  424. int lastindex = list->curlen - 1;
  425. DPRINTK(DPSTR, "removing ind %d from list 0x%p\n",
  426. index, list);
  427. if(index != lastindex) {
  428. val = m3_assp_read(card, MEMTYPE_INTERNAL_DATA,
  429. list->mem_addr + lastindex);
  430. m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  431. list->mem_addr + index,
  432. val);
  433. }
  434. m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  435. list->mem_addr + lastindex,
  436. 0);
  437. list->curlen--;
  438. }
  439. static void set_fmt(struct m3_state *s, unsigned char mask, unsigned char data)
  440. {
  441. int tmp;
  442. s->fmt = (s->fmt & mask) | data;
  443. tmp = (s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK;
  444. /* write to 'mono' word */
  445. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  446. s->dac_inst.data + SRC3_DIRECTION_OFFSET + 1,
  447. (tmp & ESS_FMT_STEREO) ? 0 : 1);
  448. /* write to '8bit' word */
  449. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  450. s->dac_inst.data + SRC3_DIRECTION_OFFSET + 2,
  451. (tmp & ESS_FMT_16BIT) ? 0 : 1);
  452. tmp = (s->fmt >> ESS_ADC_SHIFT) & ESS_FMT_MASK;
  453. /* write to 'mono' word */
  454. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  455. s->adc_inst.data + SRC3_DIRECTION_OFFSET + 1,
  456. (tmp & ESS_FMT_STEREO) ? 0 : 1);
  457. /* write to '8bit' word */
  458. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  459. s->adc_inst.data + SRC3_DIRECTION_OFFSET + 2,
  460. (tmp & ESS_FMT_16BIT) ? 0 : 1);
  461. }
  462. static void set_dac_rate(struct m3_state *s, unsigned int rate)
  463. {
  464. u32 freq;
  465. if (rate > 48000)
  466. rate = 48000;
  467. if (rate < 8000)
  468. rate = 8000;
  469. s->ratedac = rate;
  470. freq = ((rate << 15) + 24000 ) / 48000;
  471. if(freq)
  472. freq--;
  473. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  474. s->dac_inst.data + CDATA_FREQUENCY,
  475. freq);
  476. }
  477. static void set_adc_rate(struct m3_state *s, unsigned int rate)
  478. {
  479. u32 freq;
  480. if (rate > 48000)
  481. rate = 48000;
  482. if (rate < 8000)
  483. rate = 8000;
  484. s->rateadc = rate;
  485. freq = ((rate << 15) + 24000 ) / 48000;
  486. if(freq)
  487. freq--;
  488. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  489. s->adc_inst.data + CDATA_FREQUENCY,
  490. freq);
  491. }
  492. static void inc_timer_users(struct m3_card *card)
  493. {
  494. unsigned long flags;
  495. spin_lock_irqsave(&card->lock, flags);
  496. card->timer_users++;
  497. DPRINTK(DPSYS, "inc timer users now %d\n",
  498. card->timer_users);
  499. if(card->timer_users != 1)
  500. goto out;
  501. __m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  502. KDATA_TIMER_COUNT_RELOAD,
  503. 240 ) ;
  504. __m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  505. KDATA_TIMER_COUNT_CURRENT,
  506. 240 ) ;
  507. m3_outw(card,
  508. m3_inw(card, HOST_INT_CTRL) | CLKRUN_GEN_ENABLE,
  509. HOST_INT_CTRL);
  510. out:
  511. spin_unlock_irqrestore(&card->lock, flags);
  512. }
  513. static void dec_timer_users(struct m3_card *card)
  514. {
  515. unsigned long flags;
  516. spin_lock_irqsave(&card->lock, flags);
  517. card->timer_users--;
  518. DPRINTK(DPSYS, "dec timer users now %d\n",
  519. card->timer_users);
  520. if(card->timer_users > 0 )
  521. goto out;
  522. __m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  523. KDATA_TIMER_COUNT_RELOAD,
  524. 0 ) ;
  525. __m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  526. KDATA_TIMER_COUNT_CURRENT,
  527. 0 ) ;
  528. m3_outw(card, m3_inw(card, HOST_INT_CTRL) & ~CLKRUN_GEN_ENABLE,
  529. HOST_INT_CTRL);
  530. out:
  531. spin_unlock_irqrestore(&card->lock, flags);
  532. }
  533. /*
  534. * {start,stop}_{adc,dac} should be called
  535. * while holding the 'state' lock and they
  536. * will try to grab the 'card' lock..
  537. */
  538. static void stop_adc(struct m3_state *s)
  539. {
  540. if (! (s->enable & ADC_RUNNING))
  541. return;
  542. s->enable &= ~ADC_RUNNING;
  543. dec_timer_users(s->card);
  544. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  545. s->adc_inst.data + CDATA_INSTANCE_READY, 0);
  546. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  547. KDATA_ADC1_REQUEST, 0);
  548. }
  549. static void stop_dac(struct m3_state *s)
  550. {
  551. if (! (s->enable & DAC_RUNNING))
  552. return;
  553. DPRINTK(DPSYS, "stop_dac()\n");
  554. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  555. s->dac_inst.data + CDATA_INSTANCE_READY, 0);
  556. s->enable &= ~DAC_RUNNING;
  557. s->card->dacs_active--;
  558. dec_timer_users(s->card);
  559. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  560. KDATA_MIXER_TASK_NUMBER,
  561. s->card->dacs_active ) ;
  562. }
  563. static void start_dac(struct m3_state *s)
  564. {
  565. if( (!s->dma_dac.mapped && s->dma_dac.count < 1) ||
  566. !s->dma_dac.ready ||
  567. (s->enable & DAC_RUNNING))
  568. return;
  569. DPRINTK(DPSYS, "start_dac()\n");
  570. s->enable |= DAC_RUNNING;
  571. s->card->dacs_active++;
  572. inc_timer_users(s->card);
  573. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  574. s->dac_inst.data + CDATA_INSTANCE_READY, 1);
  575. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  576. KDATA_MIXER_TASK_NUMBER,
  577. s->card->dacs_active ) ;
  578. }
  579. static void start_adc(struct m3_state *s)
  580. {
  581. if ((! s->dma_adc.mapped &&
  582. s->dma_adc.count >= (signed)(s->dma_adc.dmasize - 2*s->dma_adc.fragsize))
  583. || !s->dma_adc.ready
  584. || (s->enable & ADC_RUNNING) )
  585. return;
  586. DPRINTK(DPSYS, "start_adc()\n");
  587. s->enable |= ADC_RUNNING;
  588. inc_timer_users(s->card);
  589. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  590. KDATA_ADC1_REQUEST, 1);
  591. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  592. s->adc_inst.data + CDATA_INSTANCE_READY, 1);
  593. }
  594. static struct play_vals {
  595. u16 addr, val;
  596. } pv[] = {
  597. {CDATA_LEFT_VOLUME, ARB_VOLUME},
  598. {CDATA_RIGHT_VOLUME, ARB_VOLUME},
  599. {SRC3_DIRECTION_OFFSET, 0} ,
  600. /* +1, +2 are stereo/16 bit */
  601. {SRC3_DIRECTION_OFFSET + 3, 0x0000}, /* fraction? */
  602. {SRC3_DIRECTION_OFFSET + 4, 0}, /* first l */
  603. {SRC3_DIRECTION_OFFSET + 5, 0}, /* first r */
  604. {SRC3_DIRECTION_OFFSET + 6, 0}, /* second l */
  605. {SRC3_DIRECTION_OFFSET + 7, 0}, /* second r */
  606. {SRC3_DIRECTION_OFFSET + 8, 0}, /* delta l */
  607. {SRC3_DIRECTION_OFFSET + 9, 0}, /* delta r */
  608. {SRC3_DIRECTION_OFFSET + 10, 0x8000}, /* round */
  609. {SRC3_DIRECTION_OFFSET + 11, 0xFF00}, /* higher bute mark */
  610. {SRC3_DIRECTION_OFFSET + 13, 0}, /* temp0 */
  611. {SRC3_DIRECTION_OFFSET + 14, 0}, /* c fraction */
  612. {SRC3_DIRECTION_OFFSET + 15, 0}, /* counter */
  613. {SRC3_DIRECTION_OFFSET + 16, 8}, /* numin */
  614. {SRC3_DIRECTION_OFFSET + 17, 50*2}, /* numout */
  615. {SRC3_DIRECTION_OFFSET + 18, MINISRC_BIQUAD_STAGE - 1}, /* numstage */
  616. {SRC3_DIRECTION_OFFSET + 20, 0}, /* filtertap */
  617. {SRC3_DIRECTION_OFFSET + 21, 0} /* booster */
  618. };
  619. /* the mode passed should be already shifted and masked */
  620. static void m3_play_setup(struct m3_state *s, int mode, u32 rate, void *buffer, int size)
  621. {
  622. int dsp_in_size = MINISRC_IN_BUFFER_SIZE - (0x20 * 2);
  623. int dsp_out_size = MINISRC_OUT_BUFFER_SIZE - (0x20 * 2);
  624. int dsp_in_buffer = s->dac_inst.data + (MINISRC_TMP_BUFFER_SIZE / 2);
  625. int dsp_out_buffer = dsp_in_buffer + (dsp_in_size / 2) + 1;
  626. struct dmabuf *db = &s->dma_dac;
  627. int i;
  628. DPRINTK(DPSTR, "mode=%d rate=%d buf=%p len=%d.\n",
  629. mode, rate, buffer, size);
  630. #define LO(x) ((x) & 0xffff)
  631. #define HI(x) LO((x) >> 16)
  632. /* host dma buffer pointers */
  633. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  634. s->dac_inst.data + CDATA_HOST_SRC_ADDRL,
  635. LO(virt_to_bus(buffer)));
  636. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  637. s->dac_inst.data + CDATA_HOST_SRC_ADDRH,
  638. HI(virt_to_bus(buffer)));
  639. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  640. s->dac_inst.data + CDATA_HOST_SRC_END_PLUS_1L,
  641. LO(virt_to_bus(buffer) + size));
  642. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  643. s->dac_inst.data + CDATA_HOST_SRC_END_PLUS_1H,
  644. HI(virt_to_bus(buffer) + size));
  645. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  646. s->dac_inst.data + CDATA_HOST_SRC_CURRENTL,
  647. LO(virt_to_bus(buffer)));
  648. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  649. s->dac_inst.data + CDATA_HOST_SRC_CURRENTH,
  650. HI(virt_to_bus(buffer)));
  651. #undef LO
  652. #undef HI
  653. /* dsp buffers */
  654. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  655. s->dac_inst.data + CDATA_IN_BUF_BEGIN,
  656. dsp_in_buffer);
  657. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  658. s->dac_inst.data + CDATA_IN_BUF_END_PLUS_1,
  659. dsp_in_buffer + (dsp_in_size / 2));
  660. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  661. s->dac_inst.data + CDATA_IN_BUF_HEAD,
  662. dsp_in_buffer);
  663. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  664. s->dac_inst.data + CDATA_IN_BUF_TAIL,
  665. dsp_in_buffer);
  666. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  667. s->dac_inst.data + CDATA_OUT_BUF_BEGIN,
  668. dsp_out_buffer);
  669. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  670. s->dac_inst.data + CDATA_OUT_BUF_END_PLUS_1,
  671. dsp_out_buffer + (dsp_out_size / 2));
  672. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  673. s->dac_inst.data + CDATA_OUT_BUF_HEAD,
  674. dsp_out_buffer);
  675. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  676. s->dac_inst.data + CDATA_OUT_BUF_TAIL,
  677. dsp_out_buffer);
  678. /*
  679. * some per client initializers
  680. */
  681. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  682. s->dac_inst.data + SRC3_DIRECTION_OFFSET + 12,
  683. s->dac_inst.data + 40 + 8);
  684. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  685. s->dac_inst.data + SRC3_DIRECTION_OFFSET + 19,
  686. s->dac_inst.code + MINISRC_COEF_LOC);
  687. /* enable or disable low pass filter? */
  688. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  689. s->dac_inst.data + SRC3_DIRECTION_OFFSET + 22,
  690. s->ratedac > 45000 ? 0xff : 0 );
  691. /* tell it which way dma is going? */
  692. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  693. s->dac_inst.data + CDATA_DMA_CONTROL,
  694. DMACONTROL_AUTOREPEAT + DMAC_PAGE3_SELECTOR + DMAC_BLOCKF_SELECTOR);
  695. /*
  696. * set an armload of static initializers
  697. */
  698. for(i = 0 ; i < (sizeof(pv) / sizeof(pv[0])) ; i++)
  699. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  700. s->dac_inst.data + pv[i].addr, pv[i].val);
  701. /*
  702. * put us in the lists if we're not already there
  703. */
  704. if(db->in_lists == 0) {
  705. db->msrc_index = m3_add_list(s->card, &s->card->msrc_list,
  706. s->dac_inst.data >> DP_SHIFT_COUNT);
  707. db->dma_index = m3_add_list(s->card, &s->card->dma_list,
  708. s->dac_inst.data >> DP_SHIFT_COUNT);
  709. db->mixer_index = m3_add_list(s->card, &s->card->mixer_list,
  710. s->dac_inst.data >> DP_SHIFT_COUNT);
  711. db->in_lists = 1;
  712. }
  713. set_dac_rate(s,rate);
  714. start_dac(s);
  715. }
  716. /*
  717. * Native record driver
  718. */
  719. static struct rec_vals {
  720. u16 addr, val;
  721. } rv[] = {
  722. {CDATA_LEFT_VOLUME, ARB_VOLUME},
  723. {CDATA_RIGHT_VOLUME, ARB_VOLUME},
  724. {SRC3_DIRECTION_OFFSET, 1} ,
  725. /* +1, +2 are stereo/16 bit */
  726. {SRC3_DIRECTION_OFFSET + 3, 0x0000}, /* fraction? */
  727. {SRC3_DIRECTION_OFFSET + 4, 0}, /* first l */
  728. {SRC3_DIRECTION_OFFSET + 5, 0}, /* first r */
  729. {SRC3_DIRECTION_OFFSET + 6, 0}, /* second l */
  730. {SRC3_DIRECTION_OFFSET + 7, 0}, /* second r */
  731. {SRC3_DIRECTION_OFFSET + 8, 0}, /* delta l */
  732. {SRC3_DIRECTION_OFFSET + 9, 0}, /* delta r */
  733. {SRC3_DIRECTION_OFFSET + 10, 0x8000}, /* round */
  734. {SRC3_DIRECTION_OFFSET + 11, 0xFF00}, /* higher bute mark */
  735. {SRC3_DIRECTION_OFFSET + 13, 0}, /* temp0 */
  736. {SRC3_DIRECTION_OFFSET + 14, 0}, /* c fraction */
  737. {SRC3_DIRECTION_OFFSET + 15, 0}, /* counter */
  738. {SRC3_DIRECTION_OFFSET + 16, 50},/* numin */
  739. {SRC3_DIRECTION_OFFSET + 17, 8}, /* numout */
  740. {SRC3_DIRECTION_OFFSET + 18, 0}, /* numstage */
  741. {SRC3_DIRECTION_OFFSET + 19, 0}, /* coef */
  742. {SRC3_DIRECTION_OFFSET + 20, 0}, /* filtertap */
  743. {SRC3_DIRECTION_OFFSET + 21, 0}, /* booster */
  744. {SRC3_DIRECTION_OFFSET + 22, 0xff} /* skip lpf */
  745. };
  746. /* again, passed mode is alrady shifted/masked */
  747. static void m3_rec_setup(struct m3_state *s, int mode, u32 rate, void *buffer, int size)
  748. {
  749. int dsp_in_size = MINISRC_IN_BUFFER_SIZE + (0x10 * 2);
  750. int dsp_out_size = MINISRC_OUT_BUFFER_SIZE - (0x10 * 2);
  751. int dsp_in_buffer = s->adc_inst.data + (MINISRC_TMP_BUFFER_SIZE / 2);
  752. int dsp_out_buffer = dsp_in_buffer + (dsp_in_size / 2) + 1;
  753. struct dmabuf *db = &s->dma_adc;
  754. int i;
  755. DPRINTK(DPSTR, "rec_setup mode=%d rate=%d buf=%p len=%d.\n",
  756. mode, rate, buffer, size);
  757. #define LO(x) ((x) & 0xffff)
  758. #define HI(x) LO((x) >> 16)
  759. /* host dma buffer pointers */
  760. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  761. s->adc_inst.data + CDATA_HOST_SRC_ADDRL,
  762. LO(virt_to_bus(buffer)));
  763. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  764. s->adc_inst.data + CDATA_HOST_SRC_ADDRH,
  765. HI(virt_to_bus(buffer)));
  766. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  767. s->adc_inst.data + CDATA_HOST_SRC_END_PLUS_1L,
  768. LO(virt_to_bus(buffer) + size));
  769. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  770. s->adc_inst.data + CDATA_HOST_SRC_END_PLUS_1H,
  771. HI(virt_to_bus(buffer) + size));
  772. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  773. s->adc_inst.data + CDATA_HOST_SRC_CURRENTL,
  774. LO(virt_to_bus(buffer)));
  775. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  776. s->adc_inst.data + CDATA_HOST_SRC_CURRENTH,
  777. HI(virt_to_bus(buffer)));
  778. #undef LO
  779. #undef HI
  780. /* dsp buffers */
  781. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  782. s->adc_inst.data + CDATA_IN_BUF_BEGIN,
  783. dsp_in_buffer);
  784. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  785. s->adc_inst.data + CDATA_IN_BUF_END_PLUS_1,
  786. dsp_in_buffer + (dsp_in_size / 2));
  787. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  788. s->adc_inst.data + CDATA_IN_BUF_HEAD,
  789. dsp_in_buffer);
  790. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  791. s->adc_inst.data + CDATA_IN_BUF_TAIL,
  792. dsp_in_buffer);
  793. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  794. s->adc_inst.data + CDATA_OUT_BUF_BEGIN,
  795. dsp_out_buffer);
  796. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  797. s->adc_inst.data + CDATA_OUT_BUF_END_PLUS_1,
  798. dsp_out_buffer + (dsp_out_size / 2));
  799. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  800. s->adc_inst.data + CDATA_OUT_BUF_HEAD,
  801. dsp_out_buffer);
  802. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  803. s->adc_inst.data + CDATA_OUT_BUF_TAIL,
  804. dsp_out_buffer);
  805. /*
  806. * some per client initializers
  807. */
  808. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  809. s->adc_inst.data + SRC3_DIRECTION_OFFSET + 12,
  810. s->adc_inst.data + 40 + 8);
  811. /* tell it which way dma is going? */
  812. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  813. s->adc_inst.data + CDATA_DMA_CONTROL,
  814. DMACONTROL_DIRECTION + DMACONTROL_AUTOREPEAT +
  815. DMAC_PAGE3_SELECTOR + DMAC_BLOCKF_SELECTOR);
  816. /*
  817. * set an armload of static initializers
  818. */
  819. for(i = 0 ; i < (sizeof(rv) / sizeof(rv[0])) ; i++)
  820. m3_assp_write(s->card, MEMTYPE_INTERNAL_DATA,
  821. s->adc_inst.data + rv[i].addr, rv[i].val);
  822. /*
  823. * put us in the lists if we're not already there
  824. */
  825. if(db->in_lists == 0) {
  826. db->adc1_index = m3_add_list(s->card, &s->card->adc1_list,
  827. s->adc_inst.data >> DP_SHIFT_COUNT);
  828. db->dma_index = m3_add_list(s->card, &s->card->dma_list,
  829. s->adc_inst.data >> DP_SHIFT_COUNT);
  830. db->msrc_index = m3_add_list(s->card, &s->card->msrc_list,
  831. s->adc_inst.data >> DP_SHIFT_COUNT);
  832. db->in_lists = 1;
  833. }
  834. set_adc_rate(s,rate);
  835. start_adc(s);
  836. }
  837. /* --------------------------------------------------------------------- */
  838. static void set_dmaa(struct m3_state *s, unsigned int addr, unsigned int count)
  839. {
  840. DPRINTK(DPINT,"set_dmaa??\n");
  841. }
  842. static void set_dmac(struct m3_state *s, unsigned int addr, unsigned int count)
  843. {
  844. DPRINTK(DPINT,"set_dmac??\n");
  845. }
  846. static u32 get_dma_pos(struct m3_card *card,
  847. int instance_addr)
  848. {
  849. u16 hi = 0, lo = 0;
  850. int retry = 10;
  851. /*
  852. * try and get a valid answer
  853. */
  854. while(retry--) {
  855. hi = m3_assp_read(card, MEMTYPE_INTERNAL_DATA,
  856. instance_addr + CDATA_HOST_SRC_CURRENTH);
  857. lo = m3_assp_read(card, MEMTYPE_INTERNAL_DATA,
  858. instance_addr + CDATA_HOST_SRC_CURRENTL);
  859. if(hi == m3_assp_read(card, MEMTYPE_INTERNAL_DATA,
  860. instance_addr + CDATA_HOST_SRC_CURRENTH))
  861. break;
  862. }
  863. return lo | (hi<<16);
  864. }
  865. static u32 get_dmaa(struct m3_state *s)
  866. {
  867. u32 offset;
  868. offset = get_dma_pos(s->card, s->dac_inst.data) -
  869. virt_to_bus(s->dma_dac.rawbuf);
  870. DPRINTK(DPINT,"get_dmaa: 0x%08x\n",offset);
  871. return offset;
  872. }
  873. static u32 get_dmac(struct m3_state *s)
  874. {
  875. u32 offset;
  876. offset = get_dma_pos(s->card, s->adc_inst.data) -
  877. virt_to_bus(s->dma_adc.rawbuf);
  878. DPRINTK(DPINT,"get_dmac: 0x%08x\n",offset);
  879. return offset;
  880. }
  881. static int
  882. prog_dmabuf(struct m3_state *s, unsigned rec)
  883. {
  884. struct dmabuf *db = rec ? &s->dma_adc : &s->dma_dac;
  885. unsigned rate = rec ? s->rateadc : s->ratedac;
  886. unsigned bytepersec;
  887. unsigned bufs;
  888. unsigned char fmt;
  889. unsigned long flags;
  890. spin_lock_irqsave(&s->card->lock, flags);
  891. fmt = s->fmt;
  892. if (rec) {
  893. stop_adc(s);
  894. fmt >>= ESS_ADC_SHIFT;
  895. } else {
  896. stop_dac(s);
  897. fmt >>= ESS_DAC_SHIFT;
  898. }
  899. fmt &= ESS_FMT_MASK;
  900. db->hwptr = db->swptr = db->total_bytes = db->count = db->error = db->endcleared = 0;
  901. bytepersec = rate << sample_shift[fmt];
  902. bufs = PAGE_SIZE << db->buforder;
  903. if (db->ossfragshift) {
  904. if ((1000 << db->ossfragshift) < bytepersec)
  905. db->fragshift = ld2(bytepersec/1000);
  906. else
  907. db->fragshift = db->ossfragshift;
  908. } else {
  909. db->fragshift = ld2(bytepersec/100/(db->subdivision ? db->subdivision : 1));
  910. if (db->fragshift < 3)
  911. db->fragshift = 3;
  912. }
  913. db->numfrag = bufs >> db->fragshift;
  914. while (db->numfrag < 4 && db->fragshift > 3) {
  915. db->fragshift--;
  916. db->numfrag = bufs >> db->fragshift;
  917. }
  918. db->fragsize = 1 << db->fragshift;
  919. if (db->ossmaxfrags >= 4 && db->ossmaxfrags < db->numfrag)
  920. db->numfrag = db->ossmaxfrags;
  921. db->fragsamples = db->fragsize >> sample_shift[fmt];
  922. db->dmasize = db->numfrag << db->fragshift;
  923. DPRINTK(DPSTR,"prog_dmabuf: numfrag: %d fragsize: %d dmasize: %d\n",db->numfrag,db->fragsize,db->dmasize);
  924. memset(db->rawbuf, (fmt & ESS_FMT_16BIT) ? 0 : 0x80, db->dmasize);
  925. if (rec)
  926. m3_rec_setup(s, fmt, s->rateadc, db->rawbuf, db->dmasize);
  927. else
  928. m3_play_setup(s, fmt, s->ratedac, db->rawbuf, db->dmasize);
  929. db->ready = 1;
  930. spin_unlock_irqrestore(&s->card->lock, flags);
  931. return 0;
  932. }
  933. static void clear_advance(struct m3_state *s)
  934. {
  935. unsigned char c = ((s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_16BIT) ? 0 : 0x80;
  936. unsigned char *buf = s->dma_dac.rawbuf;
  937. unsigned bsize = s->dma_dac.dmasize;
  938. unsigned bptr = s->dma_dac.swptr;
  939. unsigned len = s->dma_dac.fragsize;
  940. if (bptr + len > bsize) {
  941. unsigned x = bsize - bptr;
  942. memset(buf + bptr, c, x);
  943. /* account for wrapping? */
  944. bptr = 0;
  945. len -= x;
  946. }
  947. memset(buf + bptr, c, len);
  948. }
  949. /* call with spinlock held! */
  950. static void m3_update_ptr(struct m3_state *s)
  951. {
  952. unsigned hwptr;
  953. int diff;
  954. /* update ADC pointer */
  955. if (s->dma_adc.ready) {
  956. hwptr = get_dmac(s) % s->dma_adc.dmasize;
  957. diff = (s->dma_adc.dmasize + hwptr - s->dma_adc.hwptr) % s->dma_adc.dmasize;
  958. s->dma_adc.hwptr = hwptr;
  959. s->dma_adc.total_bytes += diff;
  960. s->dma_adc.count += diff;
  961. if (s->dma_adc.count >= (signed)s->dma_adc.fragsize)
  962. wake_up(&s->dma_adc.wait);
  963. if (!s->dma_adc.mapped) {
  964. if (s->dma_adc.count > (signed)(s->dma_adc.dmasize - ((3 * s->dma_adc.fragsize) >> 1))) {
  965. stop_adc(s);
  966. /* brute force everyone back in sync, sigh */
  967. s->dma_adc.count = 0;
  968. s->dma_adc.swptr = 0;
  969. s->dma_adc.hwptr = 0;
  970. s->dma_adc.error++;
  971. }
  972. }
  973. }
  974. /* update DAC pointer */
  975. if (s->dma_dac.ready) {
  976. hwptr = get_dmaa(s) % s->dma_dac.dmasize;
  977. diff = (s->dma_dac.dmasize + hwptr - s->dma_dac.hwptr) % s->dma_dac.dmasize;
  978. DPRINTK(DPINT,"updating dac: hwptr: %6d diff: %6d count: %6d\n",
  979. hwptr,diff,s->dma_dac.count);
  980. s->dma_dac.hwptr = hwptr;
  981. s->dma_dac.total_bytes += diff;
  982. if (s->dma_dac.mapped) {
  983. s->dma_dac.count += diff;
  984. if (s->dma_dac.count >= (signed)s->dma_dac.fragsize) {
  985. wake_up(&s->dma_dac.wait);
  986. }
  987. } else {
  988. s->dma_dac.count -= diff;
  989. if (s->dma_dac.count <= 0) {
  990. DPRINTK(DPCRAP,"underflow! diff: %d (0x%x) count: %d (0x%x) hw: %d (0x%x) sw: %d (0x%x)\n",
  991. diff, diff,
  992. s->dma_dac.count,
  993. s->dma_dac.count,
  994. hwptr, hwptr,
  995. s->dma_dac.swptr,
  996. s->dma_dac.swptr);
  997. stop_dac(s);
  998. /* brute force everyone back in sync, sigh */
  999. s->dma_dac.count = 0;
  1000. s->dma_dac.swptr = hwptr;
  1001. s->dma_dac.error++;
  1002. } else if (s->dma_dac.count <= (signed)s->dma_dac.fragsize && !s->dma_dac.endcleared) {
  1003. clear_advance(s);
  1004. s->dma_dac.endcleared = 1;
  1005. }
  1006. if (s->dma_dac.count + (signed)s->dma_dac.fragsize <= (signed)s->dma_dac.dmasize) {
  1007. wake_up(&s->dma_dac.wait);
  1008. DPRINTK(DPINT,"waking up DAC count: %d sw: %d hw: %d\n",
  1009. s->dma_dac.count, s->dma_dac.swptr, hwptr);
  1010. }
  1011. }
  1012. }
  1013. }
  1014. static irqreturn_t m3_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  1015. {
  1016. struct m3_card *c = (struct m3_card *)dev_id;
  1017. struct m3_state *s = &c->channels[0];
  1018. u8 status;
  1019. status = inb(c->iobase+0x1A);
  1020. if(status == 0xff)
  1021. return IRQ_NONE;
  1022. /* presumably acking the ints? */
  1023. outw(status, c->iobase+0x1A);
  1024. if(c->in_suspend)
  1025. return IRQ_HANDLED;
  1026. /*
  1027. * ack an assp int if its running
  1028. * and has an int pending
  1029. */
  1030. if( status & ASSP_INT_PENDING) {
  1031. u8 ctl = inb(c->iobase + ASSP_CONTROL_B);
  1032. if( !(ctl & STOP_ASSP_CLOCK)) {
  1033. ctl = inb(c->iobase + ASSP_HOST_INT_STATUS );
  1034. if(ctl & DSP2HOST_REQ_TIMER) {
  1035. outb( DSP2HOST_REQ_TIMER, c->iobase + ASSP_HOST_INT_STATUS);
  1036. /* update adc/dac info if it was a timer int */
  1037. spin_lock(&c->lock);
  1038. m3_update_ptr(s);
  1039. spin_unlock(&c->lock);
  1040. }
  1041. }
  1042. }
  1043. /* XXX is this needed? */
  1044. if(status & 0x40)
  1045. outb(0x40, c->iobase+0x1A);
  1046. return IRQ_HANDLED;
  1047. }
  1048. /* --------------------------------------------------------------------- */
  1049. static const char invalid_magic[] = KERN_CRIT PFX "invalid magic value in %s\n";
  1050. #define VALIDATE_MAGIC(FOO,MAG) \
  1051. ({ \
  1052. if (!(FOO) || (FOO)->magic != MAG) { \
  1053. printk(invalid_magic,__FUNCTION__); \
  1054. return -ENXIO; \
  1055. } \
  1056. })
  1057. #define VALIDATE_STATE(a) VALIDATE_MAGIC(a,M3_STATE_MAGIC)
  1058. #define VALIDATE_CARD(a) VALIDATE_MAGIC(a,M3_CARD_MAGIC)
  1059. /* --------------------------------------------------------------------- */
  1060. static int drain_dac(struct m3_state *s, int nonblock)
  1061. {
  1062. DECLARE_WAITQUEUE(wait,current);
  1063. unsigned long flags;
  1064. int count;
  1065. signed long tmo;
  1066. if (s->dma_dac.mapped || !s->dma_dac.ready)
  1067. return 0;
  1068. set_current_state(TASK_INTERRUPTIBLE);
  1069. add_wait_queue(&s->dma_dac.wait, &wait);
  1070. for (;;) {
  1071. spin_lock_irqsave(&s->card->lock, flags);
  1072. count = s->dma_dac.count;
  1073. spin_unlock_irqrestore(&s->card->lock, flags);
  1074. if (count <= 0)
  1075. break;
  1076. if (signal_pending(current))
  1077. break;
  1078. if (nonblock) {
  1079. remove_wait_queue(&s->dma_dac.wait, &wait);
  1080. set_current_state(TASK_RUNNING);
  1081. return -EBUSY;
  1082. }
  1083. tmo = (count * HZ) / s->ratedac;
  1084. tmo >>= sample_shift[(s->fmt >> ESS_DAC_SHIFT) & ESS_FMT_MASK];
  1085. /* XXX this is just broken. someone is waking us up alot, or schedule_timeout is broken.
  1086. or something. who cares. - zach */
  1087. if (!schedule_timeout(tmo ? tmo : 1) && tmo)
  1088. DPRINTK(DPCRAP,"dma timed out?? %ld\n",jiffies);
  1089. }
  1090. remove_wait_queue(&s->dma_dac.wait, &wait);
  1091. set_current_state(TASK_RUNNING);
  1092. if (signal_pending(current))
  1093. return -ERESTARTSYS;
  1094. return 0;
  1095. }
  1096. static ssize_t m3_read(struct file *file, char __user *buffer, size_t count, loff_t *ppos)
  1097. {
  1098. struct m3_state *s = (struct m3_state *)file->private_data;
  1099. ssize_t ret;
  1100. unsigned long flags;
  1101. unsigned swptr;
  1102. int cnt;
  1103. VALIDATE_STATE(s);
  1104. if (s->dma_adc.mapped)
  1105. return -ENXIO;
  1106. if (!s->dma_adc.ready && (ret = prog_dmabuf(s, 1)))
  1107. return ret;
  1108. if (!access_ok(VERIFY_WRITE, buffer, count))
  1109. return -EFAULT;
  1110. ret = 0;
  1111. spin_lock_irqsave(&s->card->lock, flags);
  1112. while (count > 0) {
  1113. int timed_out;
  1114. swptr = s->dma_adc.swptr;
  1115. cnt = s->dma_adc.dmasize-swptr;
  1116. if (s->dma_adc.count < cnt)
  1117. cnt = s->dma_adc.count;
  1118. if (cnt > count)
  1119. cnt = count;
  1120. if (cnt <= 0) {
  1121. start_adc(s);
  1122. if (file->f_flags & O_NONBLOCK)
  1123. {
  1124. ret = ret ? ret : -EAGAIN;
  1125. goto out;
  1126. }
  1127. spin_unlock_irqrestore(&s->card->lock, flags);
  1128. timed_out = interruptible_sleep_on_timeout(&s->dma_adc.wait, HZ) == 0;
  1129. spin_lock_irqsave(&s->card->lock, flags);
  1130. if(timed_out) {
  1131. printk("read: chip lockup? dmasz %u fragsz %u count %u hwptr %u swptr %u\n",
  1132. s->dma_adc.dmasize, s->dma_adc.fragsize, s->dma_adc.count,
  1133. s->dma_adc.hwptr, s->dma_adc.swptr);
  1134. stop_adc(s);
  1135. set_dmac(s, virt_to_bus(s->dma_adc.rawbuf), s->dma_adc.numfrag << s->dma_adc.fragshift);
  1136. s->dma_adc.count = s->dma_adc.hwptr = s->dma_adc.swptr = 0;
  1137. }
  1138. if (signal_pending(current))
  1139. {
  1140. ret = ret ? ret : -ERESTARTSYS;
  1141. goto out;
  1142. }
  1143. continue;
  1144. }
  1145. spin_unlock_irqrestore(&s->card->lock, flags);
  1146. if (copy_to_user(buffer, s->dma_adc.rawbuf + swptr, cnt)) {
  1147. ret = ret ? ret : -EFAULT;
  1148. return ret;
  1149. }
  1150. spin_lock_irqsave(&s->card->lock, flags);
  1151. swptr = (swptr + cnt) % s->dma_adc.dmasize;
  1152. s->dma_adc.swptr = swptr;
  1153. s->dma_adc.count -= cnt;
  1154. count -= cnt;
  1155. buffer += cnt;
  1156. ret += cnt;
  1157. start_adc(s);
  1158. }
  1159. out:
  1160. spin_unlock_irqrestore(&s->card->lock, flags);
  1161. return ret;
  1162. }
  1163. static ssize_t m3_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
  1164. {
  1165. struct m3_state *s = (struct m3_state *)file->private_data;
  1166. ssize_t ret;
  1167. unsigned long flags;
  1168. unsigned swptr;
  1169. int cnt;
  1170. VALIDATE_STATE(s);
  1171. if (s->dma_dac.mapped)
  1172. return -ENXIO;
  1173. if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
  1174. return ret;
  1175. if (!access_ok(VERIFY_READ, buffer, count))
  1176. return -EFAULT;
  1177. ret = 0;
  1178. spin_lock_irqsave(&s->card->lock, flags);
  1179. while (count > 0) {
  1180. int timed_out;
  1181. if (s->dma_dac.count < 0) {
  1182. s->dma_dac.count = 0;
  1183. s->dma_dac.swptr = s->dma_dac.hwptr;
  1184. }
  1185. swptr = s->dma_dac.swptr;
  1186. cnt = s->dma_dac.dmasize-swptr;
  1187. if (s->dma_dac.count + cnt > s->dma_dac.dmasize)
  1188. cnt = s->dma_dac.dmasize - s->dma_dac.count;
  1189. if (cnt > count)
  1190. cnt = count;
  1191. if (cnt <= 0) {
  1192. start_dac(s);
  1193. if (file->f_flags & O_NONBLOCK) {
  1194. if(!ret) ret = -EAGAIN;
  1195. goto out;
  1196. }
  1197. spin_unlock_irqrestore(&s->card->lock, flags);
  1198. timed_out = interruptible_sleep_on_timeout(&s->dma_dac.wait, HZ) == 0;
  1199. spin_lock_irqsave(&s->card->lock, flags);
  1200. if(timed_out) {
  1201. DPRINTK(DPCRAP,"write: chip lockup? dmasz %u fragsz %u count %u hwptr %u swptr %u\n",
  1202. s->dma_dac.dmasize, s->dma_dac.fragsize, s->dma_dac.count,
  1203. s->dma_dac.hwptr, s->dma_dac.swptr);
  1204. stop_dac(s);
  1205. set_dmaa(s, virt_to_bus(s->dma_dac.rawbuf), s->dma_dac.numfrag << s->dma_dac.fragshift);
  1206. s->dma_dac.count = s->dma_dac.hwptr = s->dma_dac.swptr = 0;
  1207. }
  1208. if (signal_pending(current)) {
  1209. if (!ret) ret = -ERESTARTSYS;
  1210. goto out;
  1211. }
  1212. continue;
  1213. }
  1214. spin_unlock_irqrestore(&s->card->lock, flags);
  1215. if (copy_from_user(s->dma_dac.rawbuf + swptr, buffer, cnt)) {
  1216. if (!ret) ret = -EFAULT;
  1217. return ret;
  1218. }
  1219. spin_lock_irqsave(&s->card->lock, flags);
  1220. DPRINTK(DPSYS,"wrote %6d bytes at sw: %6d cnt: %6d while hw: %6d\n",
  1221. cnt, swptr, s->dma_dac.count, s->dma_dac.hwptr);
  1222. swptr = (swptr + cnt) % s->dma_dac.dmasize;
  1223. s->dma_dac.swptr = swptr;
  1224. s->dma_dac.count += cnt;
  1225. s->dma_dac.endcleared = 0;
  1226. count -= cnt;
  1227. buffer += cnt;
  1228. ret += cnt;
  1229. start_dac(s);
  1230. }
  1231. out:
  1232. spin_unlock_irqrestore(&s->card->lock, flags);
  1233. return ret;
  1234. }
  1235. static unsigned int m3_poll(struct file *file, struct poll_table_struct *wait)
  1236. {
  1237. struct m3_state *s = (struct m3_state *)file->private_data;
  1238. unsigned long flags;
  1239. unsigned int mask = 0;
  1240. VALIDATE_STATE(s);
  1241. if (file->f_mode & FMODE_WRITE)
  1242. poll_wait(file, &s->dma_dac.wait, wait);
  1243. if (file->f_mode & FMODE_READ)
  1244. poll_wait(file, &s->dma_adc.wait, wait);
  1245. spin_lock_irqsave(&s->card->lock, flags);
  1246. m3_update_ptr(s);
  1247. if (file->f_mode & FMODE_READ) {
  1248. if (s->dma_adc.count >= (signed)s->dma_adc.fragsize)
  1249. mask |= POLLIN | POLLRDNORM;
  1250. }
  1251. if (file->f_mode & FMODE_WRITE) {
  1252. if (s->dma_dac.mapped) {
  1253. if (s->dma_dac.count >= (signed)s->dma_dac.fragsize)
  1254. mask |= POLLOUT | POLLWRNORM;
  1255. } else {
  1256. if ((signed)s->dma_dac.dmasize >= s->dma_dac.count + (signed)s->dma_dac.fragsize)
  1257. mask |= POLLOUT | POLLWRNORM;
  1258. }
  1259. }
  1260. spin_unlock_irqrestore(&s->card->lock, flags);
  1261. return mask;
  1262. }
  1263. static int m3_mmap(struct file *file, struct vm_area_struct *vma)
  1264. {
  1265. struct m3_state *s = (struct m3_state *)file->private_data;
  1266. unsigned long max_size, size, start, offset;
  1267. struct dmabuf *db;
  1268. int ret = -EINVAL;
  1269. VALIDATE_STATE(s);
  1270. if (vma->vm_flags & VM_WRITE) {
  1271. if ((ret = prog_dmabuf(s, 0)) != 0)
  1272. return ret;
  1273. db = &s->dma_dac;
  1274. } else
  1275. if (vma->vm_flags & VM_READ) {
  1276. if ((ret = prog_dmabuf(s, 1)) != 0)
  1277. return ret;
  1278. db = &s->dma_adc;
  1279. } else
  1280. return -EINVAL;
  1281. max_size = db->dmasize;
  1282. start = vma->vm_start;
  1283. offset = (vma->vm_pgoff << PAGE_SHIFT);
  1284. size = vma->vm_end - vma->vm_start;
  1285. if(size > max_size)
  1286. goto out;
  1287. if(offset > max_size - size)
  1288. goto out;
  1289. /*
  1290. * this will be ->nopage() once I can
  1291. * ask Jeff what the hell I'm doing wrong.
  1292. */
  1293. ret = -EAGAIN;
  1294. if (remap_pfn_range(vma, vma->vm_start,
  1295. virt_to_phys(db->rawbuf) >> PAGE_SHIFT,
  1296. size, vma->vm_page_prot))
  1297. goto out;
  1298. db->mapped = 1;
  1299. ret = 0;
  1300. out:
  1301. return ret;
  1302. }
  1303. /*
  1304. * this function is a disaster..
  1305. */
  1306. #define get_user_ret(x, ptr, ret) ({ if(get_user(x, ptr)) return ret; })
  1307. static int m3_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
  1308. {
  1309. struct m3_state *s = (struct m3_state *)file->private_data;
  1310. struct m3_card *card=s->card;
  1311. unsigned long flags;
  1312. audio_buf_info abinfo;
  1313. count_info cinfo;
  1314. int val, mapped, ret;
  1315. unsigned char fmtm, fmtd;
  1316. void __user *argp = (void __user *)arg;
  1317. int __user *p = argp;
  1318. VALIDATE_STATE(s);
  1319. mapped = ((file->f_mode & FMODE_WRITE) && s->dma_dac.mapped) ||
  1320. ((file->f_mode & FMODE_READ) && s->dma_adc.mapped);
  1321. DPRINTK(DPSYS,"m3_ioctl: cmd %d\n", cmd);
  1322. switch (cmd) {
  1323. case OSS_GETVERSION:
  1324. return put_user(SOUND_VERSION, p);
  1325. case SNDCTL_DSP_SYNC:
  1326. if (file->f_mode & FMODE_WRITE)
  1327. return drain_dac(s, file->f_flags & O_NONBLOCK);
  1328. return 0;
  1329. case SNDCTL_DSP_SETDUPLEX:
  1330. /* XXX fix */
  1331. return 0;
  1332. case SNDCTL_DSP_GETCAPS:
  1333. return put_user(DSP_CAP_DUPLEX | DSP_CAP_REALTIME | DSP_CAP_TRIGGER | DSP_CAP_MMAP, p);
  1334. case SNDCTL_DSP_RESET:
  1335. spin_lock_irqsave(&card->lock, flags);
  1336. if (file->f_mode & FMODE_WRITE) {
  1337. stop_dac(s);
  1338. synchronize_irq(s->card->pcidev->irq);
  1339. s->dma_dac.swptr = s->dma_dac.hwptr = s->dma_dac.count = s->dma_dac.total_bytes = 0;
  1340. }
  1341. if (file->f_mode & FMODE_READ) {
  1342. stop_adc(s);
  1343. synchronize_irq(s->card->pcidev->irq);
  1344. s->dma_adc.swptr = s->dma_adc.hwptr = s->dma_adc.count = s->dma_adc.total_bytes = 0;
  1345. }
  1346. spin_unlock_irqrestore(&card->lock, flags);
  1347. return 0;
  1348. case SNDCTL_DSP_SPEED:
  1349. get_user_ret(val, p, -EFAULT);
  1350. spin_lock_irqsave(&card->lock, flags);
  1351. if (val >= 0) {
  1352. if (file->f_mode & FMODE_READ) {
  1353. stop_adc(s);
  1354. s->dma_adc.ready = 0;
  1355. set_adc_rate(s, val);
  1356. }
  1357. if (file->f_mode & FMODE_WRITE) {
  1358. stop_dac(s);
  1359. s->dma_dac.ready = 0;
  1360. set_dac_rate(s, val);
  1361. }
  1362. }
  1363. spin_unlock_irqrestore(&card->lock, flags);
  1364. return put_user((file->f_mode & FMODE_READ) ? s->rateadc : s->ratedac, p);
  1365. case SNDCTL_DSP_STEREO:
  1366. get_user_ret(val, p, -EFAULT);
  1367. spin_lock_irqsave(&card->lock, flags);
  1368. fmtd = 0;
  1369. fmtm = ~0;
  1370. if (file->f_mode & FMODE_READ) {
  1371. stop_adc(s);
  1372. s->dma_adc.ready = 0;
  1373. if (val)
  1374. fmtd |= ESS_FMT_STEREO << ESS_ADC_SHIFT;
  1375. else
  1376. fmtm &= ~(ESS_FMT_STEREO << ESS_ADC_SHIFT);
  1377. }
  1378. if (file->f_mode & FMODE_WRITE) {
  1379. stop_dac(s);
  1380. s->dma_dac.ready = 0;
  1381. if (val)
  1382. fmtd |= ESS_FMT_STEREO << ESS_DAC_SHIFT;
  1383. else
  1384. fmtm &= ~(ESS_FMT_STEREO << ESS_DAC_SHIFT);
  1385. }
  1386. set_fmt(s, fmtm, fmtd);
  1387. spin_unlock_irqrestore(&card->lock, flags);
  1388. return 0;
  1389. case SNDCTL_DSP_CHANNELS:
  1390. get_user_ret(val, p, -EFAULT);
  1391. spin_lock_irqsave(&card->lock, flags);
  1392. if (val != 0) {
  1393. fmtd = 0;
  1394. fmtm = ~0;
  1395. if (file->f_mode & FMODE_READ) {
  1396. stop_adc(s);
  1397. s->dma_adc.ready = 0;
  1398. if (val >= 2)
  1399. fmtd |= ESS_FMT_STEREO << ESS_ADC_SHIFT;
  1400. else
  1401. fmtm &= ~(ESS_FMT_STEREO << ESS_ADC_SHIFT);
  1402. }
  1403. if (file->f_mode & FMODE_WRITE) {
  1404. stop_dac(s);
  1405. s->dma_dac.ready = 0;
  1406. if (val >= 2)
  1407. fmtd |= ESS_FMT_STEREO << ESS_DAC_SHIFT;
  1408. else
  1409. fmtm &= ~(ESS_FMT_STEREO << ESS_DAC_SHIFT);
  1410. }
  1411. set_fmt(s, fmtm, fmtd);
  1412. }
  1413. spin_unlock_irqrestore(&card->lock, flags);
  1414. return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? (ESS_FMT_STEREO << ESS_ADC_SHIFT)
  1415. : (ESS_FMT_STEREO << ESS_DAC_SHIFT))) ? 2 : 1, p);
  1416. case SNDCTL_DSP_GETFMTS: /* Returns a mask */
  1417. return put_user(AFMT_U8|AFMT_S16_LE, p);
  1418. case SNDCTL_DSP_SETFMT: /* Selects ONE fmt*/
  1419. get_user_ret(val, p, -EFAULT);
  1420. spin_lock_irqsave(&card->lock, flags);
  1421. if (val != AFMT_QUERY) {
  1422. fmtd = 0;
  1423. fmtm = ~0;
  1424. if (file->f_mode & FMODE_READ) {
  1425. stop_adc(s);
  1426. s->dma_adc.ready = 0;
  1427. if (val == AFMT_S16_LE)
  1428. fmtd |= ESS_FMT_16BIT << ESS_ADC_SHIFT;
  1429. else
  1430. fmtm &= ~(ESS_FMT_16BIT << ESS_ADC_SHIFT);
  1431. }
  1432. if (file->f_mode & FMODE_WRITE) {
  1433. stop_dac(s);
  1434. s->dma_dac.ready = 0;
  1435. if (val == AFMT_S16_LE)
  1436. fmtd |= ESS_FMT_16BIT << ESS_DAC_SHIFT;
  1437. else
  1438. fmtm &= ~(ESS_FMT_16BIT << ESS_DAC_SHIFT);
  1439. }
  1440. set_fmt(s, fmtm, fmtd);
  1441. }
  1442. spin_unlock_irqrestore(&card->lock, flags);
  1443. return put_user((s->fmt & ((file->f_mode & FMODE_READ) ?
  1444. (ESS_FMT_16BIT << ESS_ADC_SHIFT)
  1445. : (ESS_FMT_16BIT << ESS_DAC_SHIFT))) ?
  1446. AFMT_S16_LE :
  1447. AFMT_U8,
  1448. p);
  1449. case SNDCTL_DSP_POST:
  1450. return 0;
  1451. case SNDCTL_DSP_GETTRIGGER:
  1452. val = 0;
  1453. if ((file->f_mode & FMODE_READ) && (s->enable & ADC_RUNNING))
  1454. val |= PCM_ENABLE_INPUT;
  1455. if ((file->f_mode & FMODE_WRITE) && (s->enable & DAC_RUNNING))
  1456. val |= PCM_ENABLE_OUTPUT;
  1457. return put_user(val, p);
  1458. case SNDCTL_DSP_SETTRIGGER:
  1459. get_user_ret(val, p, -EFAULT);
  1460. if (file->f_mode & FMODE_READ) {
  1461. if (val & PCM_ENABLE_INPUT) {
  1462. if (!s->dma_adc.ready && (ret = prog_dmabuf(s, 1)))
  1463. return ret;
  1464. start_adc(s);
  1465. } else
  1466. stop_adc(s);
  1467. }
  1468. if (file->f_mode & FMODE_WRITE) {
  1469. if (val & PCM_ENABLE_OUTPUT) {
  1470. if (!s->dma_dac.ready && (ret = prog_dmabuf(s, 0)))
  1471. return ret;
  1472. start_dac(s);
  1473. } else
  1474. stop_dac(s);
  1475. }
  1476. return 0;
  1477. case SNDCTL_DSP_GETOSPACE:
  1478. if (!(file->f_mode & FMODE_WRITE))
  1479. return -EINVAL;
  1480. if (!(s->enable & DAC_RUNNING) && (val = prog_dmabuf(s, 0)) != 0)
  1481. return val;
  1482. spin_lock_irqsave(&card->lock, flags);
  1483. m3_update_ptr(s);
  1484. abinfo.fragsize = s->dma_dac.fragsize;
  1485. abinfo.bytes = s->dma_dac.dmasize - s->dma_dac.count;
  1486. abinfo.fragstotal = s->dma_dac.numfrag;
  1487. abinfo.fragments = abinfo.bytes >> s->dma_dac.fragshift;
  1488. spin_unlock_irqrestore(&card->lock, flags);
  1489. return copy_to_user(argp, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  1490. case SNDCTL_DSP_GETISPACE:
  1491. if (!(file->f_mode & FMODE_READ))
  1492. return -EINVAL;
  1493. if (!(s->enable & ADC_RUNNING) && (val = prog_dmabuf(s, 1)) != 0)
  1494. return val;
  1495. spin_lock_irqsave(&card->lock, flags);
  1496. m3_update_ptr(s);
  1497. abinfo.fragsize = s->dma_adc.fragsize;
  1498. abinfo.bytes = s->dma_adc.count;
  1499. abinfo.fragstotal = s->dma_adc.numfrag;
  1500. abinfo.fragments = abinfo.bytes >> s->dma_adc.fragshift;
  1501. spin_unlock_irqrestore(&card->lock, flags);
  1502. return copy_to_user(argp, &abinfo, sizeof(abinfo)) ? -EFAULT : 0;
  1503. case SNDCTL_DSP_NONBLOCK:
  1504. file->f_flags |= O_NONBLOCK;
  1505. return 0;
  1506. case SNDCTL_DSP_GETODELAY:
  1507. if (!(file->f_mode & FMODE_WRITE))
  1508. return -EINVAL;
  1509. spin_lock_irqsave(&card->lock, flags);
  1510. m3_update_ptr(s);
  1511. val = s->dma_dac.count;
  1512. spin_unlock_irqrestore(&card->lock, flags);
  1513. return put_user(val, p);
  1514. case SNDCTL_DSP_GETIPTR:
  1515. if (!(file->f_mode & FMODE_READ))
  1516. return -EINVAL;
  1517. spin_lock_irqsave(&card->lock, flags);
  1518. m3_update_ptr(s);
  1519. cinfo.bytes = s->dma_adc.total_bytes;
  1520. cinfo.blocks = s->dma_adc.count >> s->dma_adc.fragshift;
  1521. cinfo.ptr = s->dma_adc.hwptr;
  1522. if (s->dma_adc.mapped)
  1523. s->dma_adc.count &= s->dma_adc.fragsize-1;
  1524. spin_unlock_irqrestore(&card->lock, flags);
  1525. if (copy_to_user(argp, &cinfo, sizeof(cinfo)))
  1526. return -EFAULT;
  1527. return 0;
  1528. case SNDCTL_DSP_GETOPTR:
  1529. if (!(file->f_mode & FMODE_WRITE))
  1530. return -EINVAL;
  1531. spin_lock_irqsave(&card->lock, flags);
  1532. m3_update_ptr(s);
  1533. cinfo.bytes = s->dma_dac.total_bytes;
  1534. cinfo.blocks = s->dma_dac.count >> s->dma_dac.fragshift;
  1535. cinfo.ptr = s->dma_dac.hwptr;
  1536. if (s->dma_dac.mapped)
  1537. s->dma_dac.count &= s->dma_dac.fragsize-1;
  1538. spin_unlock_irqrestore(&card->lock, flags);
  1539. if (copy_to_user(argp, &cinfo, sizeof(cinfo)))
  1540. return -EFAULT;
  1541. return 0;
  1542. case SNDCTL_DSP_GETBLKSIZE:
  1543. if (file->f_mode & FMODE_WRITE) {
  1544. if ((val = prog_dmabuf(s, 0)))
  1545. return val;
  1546. return put_user(s->dma_dac.fragsize, p);
  1547. }
  1548. if ((val = prog_dmabuf(s, 1)))
  1549. return val;
  1550. return put_user(s->dma_adc.fragsize, p);
  1551. case SNDCTL_DSP_SETFRAGMENT:
  1552. get_user_ret(val, p, -EFAULT);
  1553. spin_lock_irqsave(&card->lock, flags);
  1554. if (file->f_mode & FMODE_READ) {
  1555. s->dma_adc.ossfragshift = val & 0xffff;
  1556. s->dma_adc.ossmaxfrags = (val >> 16) & 0xffff;
  1557. if (s->dma_adc.ossfragshift < 4)
  1558. s->dma_adc.ossfragshift = 4;
  1559. if (s->dma_adc.ossfragshift > 15)
  1560. s->dma_adc.ossfragshift = 15;
  1561. if (s->dma_adc.ossmaxfrags < 4)
  1562. s->dma_adc.ossmaxfrags = 4;
  1563. }
  1564. if (file->f_mode & FMODE_WRITE) {
  1565. s->dma_dac.ossfragshift = val & 0xffff;
  1566. s->dma_dac.ossmaxfrags = (val >> 16) & 0xffff;
  1567. if (s->dma_dac.ossfragshift < 4)
  1568. s->dma_dac.ossfragshift = 4;
  1569. if (s->dma_dac.ossfragshift > 15)
  1570. s->dma_dac.ossfragshift = 15;
  1571. if (s->dma_dac.ossmaxfrags < 4)
  1572. s->dma_dac.ossmaxfrags = 4;
  1573. }
  1574. spin_unlock_irqrestore(&card->lock, flags);
  1575. return 0;
  1576. case SNDCTL_DSP_SUBDIVIDE:
  1577. if ((file->f_mode & FMODE_READ && s->dma_adc.subdivision) ||
  1578. (file->f_mode & FMODE_WRITE && s->dma_dac.subdivision))
  1579. return -EINVAL;
  1580. get_user_ret(val, p, -EFAULT);
  1581. if (val != 1 && val != 2 && val != 4)
  1582. return -EINVAL;
  1583. if (file->f_mode & FMODE_READ)
  1584. s->dma_adc.subdivision = val;
  1585. if (file->f_mode & FMODE_WRITE)
  1586. s->dma_dac.subdivision = val;
  1587. return 0;
  1588. case SOUND_PCM_READ_RATE:
  1589. return put_user((file->f_mode & FMODE_READ) ? s->rateadc : s->ratedac, p);
  1590. case SOUND_PCM_READ_CHANNELS:
  1591. return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? (ESS_FMT_STEREO << ESS_ADC_SHIFT)
  1592. : (ESS_FMT_STEREO << ESS_DAC_SHIFT))) ? 2 : 1, p);
  1593. case SOUND_PCM_READ_BITS:
  1594. return put_user((s->fmt & ((file->f_mode & FMODE_READ) ? (ESS_FMT_16BIT << ESS_ADC_SHIFT)
  1595. : (ESS_FMT_16BIT << ESS_DAC_SHIFT))) ? 16 : 8, p);
  1596. case SOUND_PCM_WRITE_FILTER:
  1597. case SNDCTL_DSP_SETSYNCRO:
  1598. case SOUND_PCM_READ_FILTER:
  1599. return -EINVAL;
  1600. }
  1601. return -EINVAL;
  1602. }
  1603. static int
  1604. allocate_dmabuf(struct pci_dev *pci_dev, struct dmabuf *db)
  1605. {
  1606. int order;
  1607. DPRINTK(DPSTR,"allocating for dmabuf %p\n", db);
  1608. /*
  1609. * alloc as big a chunk as we can, start with
  1610. * 64k 'cause we're insane. based on order cause
  1611. * the amazingly complicated prog_dmabuf wants it.
  1612. *
  1613. * pci_alloc_sonsistent guarantees that it won't cross a natural
  1614. * boundary; the m3 hardware can't have dma cross a 64k bus
  1615. * address boundary.
  1616. */
  1617. for (order = 16-PAGE_SHIFT; order >= 1; order--) {
  1618. db->rawbuf = pci_alloc_consistent(pci_dev, PAGE_SIZE << order,
  1619. &(db->handle));
  1620. if(db->rawbuf)
  1621. break;
  1622. }
  1623. if (!db->rawbuf)
  1624. return 1;
  1625. DPRINTK(DPSTR,"allocated %ld (%d) bytes at %p\n",
  1626. PAGE_SIZE<<order, order, db->rawbuf);
  1627. {
  1628. struct page *page, *pend;
  1629. pend = virt_to_page(db->rawbuf + (PAGE_SIZE << order) - 1);
  1630. for (page = virt_to_page(db->rawbuf); page <= pend; page++)
  1631. SetPageReserved(page);
  1632. }
  1633. db->buforder = order;
  1634. db->ready = 0;
  1635. db->mapped = 0;
  1636. return 0;
  1637. }
  1638. static void
  1639. nuke_lists(struct m3_card *card, struct dmabuf *db)
  1640. {
  1641. m3_remove_list(card, &(card->dma_list), db->dma_index);
  1642. m3_remove_list(card, &(card->msrc_list), db->msrc_index);
  1643. db->in_lists = 0;
  1644. }
  1645. static void
  1646. free_dmabuf(struct pci_dev *pci_dev, struct dmabuf *db)
  1647. {
  1648. if(db->rawbuf == NULL)
  1649. return;
  1650. DPRINTK(DPSTR,"freeing %p from dmabuf %p\n",db->rawbuf, db);
  1651. {
  1652. struct page *page, *pend;
  1653. pend = virt_to_page(db->rawbuf + (PAGE_SIZE << db->buforder) - 1);
  1654. for (page = virt_to_page(db->rawbuf); page <= pend; page++)
  1655. ClearPageReserved(page);
  1656. }
  1657. pci_free_consistent(pci_dev, PAGE_SIZE << db->buforder,
  1658. db->rawbuf, db->handle);
  1659. db->rawbuf = NULL;
  1660. db->buforder = 0;
  1661. db->mapped = 0;
  1662. db->ready = 0;
  1663. }
  1664. static int m3_open(struct inode *inode, struct file *file)
  1665. {
  1666. unsigned int minor = iminor(inode);
  1667. struct m3_card *c;
  1668. struct m3_state *s = NULL;
  1669. int i;
  1670. unsigned char fmtm = ~0, fmts = 0;
  1671. unsigned long flags;
  1672. /*
  1673. * Scan the cards and find the channel. We only
  1674. * do this at open time so it is ok
  1675. */
  1676. for(c = devs ; c != NULL ; c = c->next) {
  1677. for(i=0;i<NR_DSPS;i++) {
  1678. if(c->channels[i].dev_audio < 0)
  1679. continue;
  1680. if((c->channels[i].dev_audio ^ minor) & ~0xf)
  1681. continue;
  1682. s = &c->channels[i];
  1683. break;
  1684. }
  1685. }
  1686. if (!s)
  1687. return -ENODEV;
  1688. VALIDATE_STATE(s);
  1689. file->private_data = s;
  1690. /* wait for device to become free */
  1691. down(&s->open_sem);
  1692. while (s->open_mode & file->f_mode) {
  1693. if (file->f_flags & O_NONBLOCK) {
  1694. up(&s->open_sem);
  1695. return -EWOULDBLOCK;
  1696. }
  1697. up(&s->open_sem);
  1698. interruptible_sleep_on(&s->open_wait);
  1699. if (signal_pending(current))
  1700. return -ERESTARTSYS;
  1701. down(&s->open_sem);
  1702. }
  1703. spin_lock_irqsave(&c->lock, flags);
  1704. if (file->f_mode & FMODE_READ) {
  1705. fmtm &= ~((ESS_FMT_STEREO | ESS_FMT_16BIT) << ESS_ADC_SHIFT);
  1706. if ((minor & 0xf) == SND_DEV_DSP16)
  1707. fmts |= ESS_FMT_16BIT << ESS_ADC_SHIFT;
  1708. s->dma_adc.ossfragshift = s->dma_adc.ossmaxfrags = s->dma_adc.subdivision = 0;
  1709. set_adc_rate(s, 8000);
  1710. }
  1711. if (file->f_mode & FMODE_WRITE) {
  1712. fmtm &= ~((ESS_FMT_STEREO | ESS_FMT_16BIT) << ESS_DAC_SHIFT);
  1713. if ((minor & 0xf) == SND_DEV_DSP16)
  1714. fmts |= ESS_FMT_16BIT << ESS_DAC_SHIFT;
  1715. s->dma_dac.ossfragshift = s->dma_dac.ossmaxfrags = s->dma_dac.subdivision = 0;
  1716. set_dac_rate(s, 8000);
  1717. }
  1718. set_fmt(s, fmtm, fmts);
  1719. s->open_mode |= file->f_mode & (FMODE_READ | FMODE_WRITE);
  1720. up(&s->open_sem);
  1721. spin_unlock_irqrestore(&c->lock, flags);
  1722. return nonseekable_open(inode, file);
  1723. }
  1724. static int m3_release(struct inode *inode, struct file *file)
  1725. {
  1726. struct m3_state *s = (struct m3_state *)file->private_data;
  1727. struct m3_card *card=s->card;
  1728. unsigned long flags;
  1729. VALIDATE_STATE(s);
  1730. if (file->f_mode & FMODE_WRITE)
  1731. drain_dac(s, file->f_flags & O_NONBLOCK);
  1732. down(&s->open_sem);
  1733. spin_lock_irqsave(&card->lock, flags);
  1734. if (file->f_mode & FMODE_WRITE) {
  1735. stop_dac(s);
  1736. if(s->dma_dac.in_lists) {
  1737. m3_remove_list(s->card, &(s->card->mixer_list), s->dma_dac.mixer_index);
  1738. nuke_lists(s->card, &(s->dma_dac));
  1739. }
  1740. }
  1741. if (file->f_mode & FMODE_READ) {
  1742. stop_adc(s);
  1743. if(s->dma_adc.in_lists) {
  1744. m3_remove_list(s->card, &(s->card->adc1_list), s->dma_adc.adc1_index);
  1745. nuke_lists(s->card, &(s->dma_adc));
  1746. }
  1747. }
  1748. s->open_mode &= (~file->f_mode) & (FMODE_READ|FMODE_WRITE);
  1749. spin_unlock_irqrestore(&card->lock, flags);
  1750. up(&s->open_sem);
  1751. wake_up(&s->open_wait);
  1752. return 0;
  1753. }
  1754. /*
  1755. * Wait for the ac97 serial bus to be free.
  1756. * return nonzero if the bus is still busy.
  1757. */
  1758. static int m3_ac97_wait(struct m3_card *card)
  1759. {
  1760. int i = 10000;
  1761. while( (m3_inb(card, 0x30) & 1) && i--) ;
  1762. return i == 0;
  1763. }
  1764. static u16 m3_ac97_read(struct ac97_codec *codec, u8 reg)
  1765. {
  1766. u16 ret = 0;
  1767. struct m3_card *card = codec->private_data;
  1768. spin_lock(&card->ac97_lock);
  1769. if(m3_ac97_wait(card)) {
  1770. printk(KERN_ERR PFX "serial bus busy reading reg 0x%x\n",reg);
  1771. goto out;
  1772. }
  1773. m3_outb(card, 0x80 | (reg & 0x7f), 0x30);
  1774. if(m3_ac97_wait(card)) {
  1775. printk(KERN_ERR PFX "serial bus busy finishing read reg 0x%x\n",reg);
  1776. goto out;
  1777. }
  1778. ret = m3_inw(card, 0x32);
  1779. DPRINTK(DPCRAP,"reading 0x%04x from 0x%02x\n",ret, reg);
  1780. out:
  1781. spin_unlock(&card->ac97_lock);
  1782. return ret;
  1783. }
  1784. static void m3_ac97_write(struct ac97_codec *codec, u8 reg, u16 val)
  1785. {
  1786. struct m3_card *card = codec->private_data;
  1787. spin_lock(&card->ac97_lock);
  1788. if(m3_ac97_wait(card)) {
  1789. printk(KERN_ERR PFX "serial bus busy writing 0x%x to 0x%x\n",val, reg);
  1790. goto out;
  1791. }
  1792. DPRINTK(DPCRAP,"writing 0x%04x to 0x%02x\n", val, reg);
  1793. m3_outw(card, val, 0x32);
  1794. m3_outb(card, reg & 0x7f, 0x30);
  1795. out:
  1796. spin_unlock(&card->ac97_lock);
  1797. }
  1798. /* OSS /dev/mixer file operation methods */
  1799. static int m3_open_mixdev(struct inode *inode, struct file *file)
  1800. {
  1801. unsigned int minor = iminor(inode);
  1802. struct m3_card *card = devs;
  1803. for (card = devs; card != NULL; card = card->next) {
  1804. if((card->ac97 != NULL) && (card->ac97->dev_mixer == minor))
  1805. break;
  1806. }
  1807. if (!card) {
  1808. return -ENODEV;
  1809. }
  1810. file->private_data = card->ac97;
  1811. return nonseekable_open(inode, file);
  1812. }
  1813. static int m3_release_mixdev(struct inode *inode, struct file *file)
  1814. {
  1815. return 0;
  1816. }
  1817. static int m3_ioctl_mixdev(struct inode *inode, struct file *file, unsigned int cmd,
  1818. unsigned long arg)
  1819. {
  1820. struct ac97_codec *codec = (struct ac97_codec *)file->private_data;
  1821. return codec->mixer_ioctl(codec, cmd, arg);
  1822. }
  1823. static struct file_operations m3_mixer_fops = {
  1824. .owner = THIS_MODULE,
  1825. .llseek = no_llseek,
  1826. .ioctl = m3_ioctl_mixdev,
  1827. .open = m3_open_mixdev,
  1828. .release = m3_release_mixdev,
  1829. };
  1830. static void remote_codec_config(int io, int isremote)
  1831. {
  1832. isremote = isremote ? 1 : 0;
  1833. outw( (inw(io + RING_BUS_CTRL_B) & ~SECOND_CODEC_ID_MASK) | isremote,
  1834. io + RING_BUS_CTRL_B);
  1835. outw( (inw(io + SDO_OUT_DEST_CTRL) & ~COMMAND_ADDR_OUT) | isremote,
  1836. io + SDO_OUT_DEST_CTRL);
  1837. outw( (inw(io + SDO_IN_DEST_CTRL) & ~STATUS_ADDR_IN) | isremote,
  1838. io + SDO_IN_DEST_CTRL);
  1839. }
  1840. /*
  1841. * hack, returns non zero on err
  1842. */
  1843. static int try_read_vendor(struct m3_card *card)
  1844. {
  1845. u16 ret;
  1846. if(m3_ac97_wait(card))
  1847. return 1;
  1848. m3_outb(card, 0x80 | (AC97_VENDOR_ID1 & 0x7f), 0x30);
  1849. if(m3_ac97_wait(card))
  1850. return 1;
  1851. ret = m3_inw(card, 0x32);
  1852. return (ret == 0) || (ret == 0xffff);
  1853. }
  1854. static void m3_codec_reset(struct m3_card *card, int busywait)
  1855. {
  1856. u16 dir;
  1857. int delay1 = 0, delay2 = 0, i;
  1858. int io = card->iobase;
  1859. switch (card->card_type) {
  1860. /*
  1861. * the onboard codec on the allegro seems
  1862. * to want to wait a very long time before
  1863. * coming back to life
  1864. */
  1865. case ESS_ALLEGRO:
  1866. delay1 = 50;
  1867. delay2 = 800;
  1868. break;
  1869. case ESS_MAESTRO3:
  1870. case ESS_MAESTRO3HW:
  1871. delay1 = 20;
  1872. delay2 = 500;
  1873. break;
  1874. }
  1875. for(i = 0; i < 5; i ++) {
  1876. dir = inw(io + GPIO_DIRECTION);
  1877. dir |= 0x10; /* assuming pci bus master? */
  1878. remote_codec_config(io, 0);
  1879. outw(IO_SRAM_ENABLE, io + RING_BUS_CTRL_A);
  1880. udelay(20);
  1881. outw(dir & ~GPO_PRIMARY_AC97 , io + GPIO_DIRECTION);
  1882. outw(~GPO_PRIMARY_AC97 , io + GPIO_MASK);
  1883. outw(0, io + GPIO_DATA);
  1884. outw(dir | GPO_PRIMARY_AC97, io + GPIO_DIRECTION);
  1885. if(busywait) {
  1886. mdelay(delay1);
  1887. } else {
  1888. set_current_state(TASK_UNINTERRUPTIBLE);
  1889. schedule_timeout((delay1 * HZ) / 1000);
  1890. }
  1891. outw(GPO_PRIMARY_AC97, io + GPIO_DATA);
  1892. udelay(5);
  1893. /* ok, bring back the ac-link */
  1894. outw(IO_SRAM_ENABLE | SERIAL_AC_LINK_ENABLE, io + RING_BUS_CTRL_A);
  1895. outw(~0, io + GPIO_MASK);
  1896. if(busywait) {
  1897. mdelay(delay2);
  1898. } else {
  1899. set_current_state(TASK_UNINTERRUPTIBLE);
  1900. schedule_timeout((delay2 * HZ) / 1000);
  1901. }
  1902. if(! try_read_vendor(card))
  1903. break;
  1904. delay1 += 10;
  1905. delay2 += 100;
  1906. DPRINTK(DPMOD, "retrying codec reset with delays of %d and %d ms\n",
  1907. delay1, delay2);
  1908. }
  1909. #if 0
  1910. /* more gung-ho reset that doesn't
  1911. * seem to work anywhere :)
  1912. */
  1913. tmp = inw(io + RING_BUS_CTRL_A);
  1914. outw(RAC_SDFS_ENABLE|LAC_SDFS_ENABLE, io + RING_BUS_CTRL_A);
  1915. mdelay(20);
  1916. outw(tmp, io + RING_BUS_CTRL_A);
  1917. mdelay(50);
  1918. #endif
  1919. }
  1920. static int __devinit m3_codec_install(struct m3_card *card)
  1921. {
  1922. struct ac97_codec *codec;
  1923. if ((codec = ac97_alloc_codec()) == NULL)
  1924. return -ENOMEM;
  1925. codec->private_data = card;
  1926. codec->codec_read = m3_ac97_read;
  1927. codec->codec_write = m3_ac97_write;
  1928. /* someday we should support secondary codecs.. */
  1929. codec->id = 0;
  1930. if (ac97_probe_codec(codec) == 0) {
  1931. printk(KERN_ERR PFX "codec probe failed\n");
  1932. ac97_release_codec(codec);
  1933. return -1;
  1934. }
  1935. if ((codec->dev_mixer = register_sound_mixer(&m3_mixer_fops, -1)) < 0) {
  1936. printk(KERN_ERR PFX "couldn't register mixer!\n");
  1937. ac97_release_codec(codec);
  1938. return -1;
  1939. }
  1940. card->ac97 = codec;
  1941. return 0;
  1942. }
  1943. #define MINISRC_LPF_LEN 10
  1944. static u16 minisrc_lpf[MINISRC_LPF_LEN] = {
  1945. 0X0743, 0X1104, 0X0A4C, 0XF88D, 0X242C,
  1946. 0X1023, 0X1AA9, 0X0B60, 0XEFDD, 0X186F
  1947. };
  1948. static void m3_assp_init(struct m3_card *card)
  1949. {
  1950. int i;
  1951. /* zero kernel data */
  1952. for(i = 0 ; i < (REV_B_DATA_MEMORY_UNIT_LENGTH * NUM_UNITS_KERNEL_DATA) / 2; i++)
  1953. m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  1954. KDATA_BASE_ADDR + i, 0);
  1955. /* zero mixer data? */
  1956. for(i = 0 ; i < (REV_B_DATA_MEMORY_UNIT_LENGTH * NUM_UNITS_KERNEL_DATA) / 2; i++)
  1957. m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  1958. KDATA_BASE_ADDR2 + i, 0);
  1959. /* init dma pointer */
  1960. m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  1961. KDATA_CURRENT_DMA,
  1962. KDATA_DMA_XFER0);
  1963. /* write kernel into code memory.. */
  1964. for(i = 0 ; i < sizeof(assp_kernel_image) / 2; i++) {
  1965. m3_assp_write(card, MEMTYPE_INTERNAL_CODE,
  1966. REV_B_CODE_MEMORY_BEGIN + i,
  1967. assp_kernel_image[i]);
  1968. }
  1969. /*
  1970. * We only have this one client and we know that 0x400
  1971. * is free in our kernel's mem map, so lets just
  1972. * drop it there. It seems that the minisrc doesn't
  1973. * need vectors, so we won't bother with them..
  1974. */
  1975. for(i = 0 ; i < sizeof(assp_minisrc_image) / 2; i++) {
  1976. m3_assp_write(card, MEMTYPE_INTERNAL_CODE,
  1977. 0x400 + i,
  1978. assp_minisrc_image[i]);
  1979. }
  1980. /*
  1981. * write the coefficients for the low pass filter?
  1982. */
  1983. for(i = 0; i < MINISRC_LPF_LEN ; i++) {
  1984. m3_assp_write(card, MEMTYPE_INTERNAL_CODE,
  1985. 0x400 + MINISRC_COEF_LOC + i,
  1986. minisrc_lpf[i]);
  1987. }
  1988. m3_assp_write(card, MEMTYPE_INTERNAL_CODE,
  1989. 0x400 + MINISRC_COEF_LOC + MINISRC_LPF_LEN,
  1990. 0x8000);
  1991. /*
  1992. * the minisrc is the only thing on
  1993. * our task list..
  1994. */
  1995. m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  1996. KDATA_TASK0,
  1997. 0x400);
  1998. /*
  1999. * init the mixer number..
  2000. */
  2001. m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  2002. KDATA_MIXER_TASK_NUMBER,0);
  2003. /*
  2004. * EXTREME KERNEL MASTER VOLUME
  2005. */
  2006. m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  2007. KDATA_DAC_LEFT_VOLUME, ARB_VOLUME);
  2008. m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  2009. KDATA_DAC_RIGHT_VOLUME, ARB_VOLUME);
  2010. card->mixer_list.mem_addr = KDATA_MIXER_XFER0;
  2011. card->mixer_list.max = MAX_VIRTUAL_MIXER_CHANNELS;
  2012. card->adc1_list.mem_addr = KDATA_ADC1_XFER0;
  2013. card->adc1_list.max = MAX_VIRTUAL_ADC1_CHANNELS;
  2014. card->dma_list.mem_addr = KDATA_DMA_XFER0;
  2015. card->dma_list.max = MAX_VIRTUAL_DMA_CHANNELS;
  2016. card->msrc_list.mem_addr = KDATA_INSTANCE0_MINISRC;
  2017. card->msrc_list.max = MAX_INSTANCE_MINISRC;
  2018. }
  2019. static int setup_msrc(struct m3_card *card,
  2020. struct assp_instance *inst, int index)
  2021. {
  2022. int data_bytes = 2 * ( MINISRC_TMP_BUFFER_SIZE / 2 +
  2023. MINISRC_IN_BUFFER_SIZE / 2 +
  2024. 1 + MINISRC_OUT_BUFFER_SIZE / 2 + 1 );
  2025. int address, i;
  2026. /*
  2027. * the revb memory map has 0x1100 through 0x1c00
  2028. * free.
  2029. */
  2030. /*
  2031. * align instance address to 256 bytes so that it's
  2032. * shifted list address is aligned.
  2033. * list address = (mem address >> 1) >> 7;
  2034. */
  2035. data_bytes = (data_bytes + 255) & ~255;
  2036. address = 0x1100 + ((data_bytes/2) * index);
  2037. if((address + (data_bytes/2)) >= 0x1c00) {
  2038. printk(KERN_ERR PFX "no memory for %d bytes at ind %d (addr 0x%x)\n",
  2039. data_bytes, index, address);
  2040. return -1;
  2041. }
  2042. for(i = 0; i < data_bytes/2 ; i++)
  2043. m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  2044. address + i, 0);
  2045. inst->code = 0x400;
  2046. inst->data = address;
  2047. return 0;
  2048. }
  2049. static int m3_assp_client_init(struct m3_state *s)
  2050. {
  2051. setup_msrc(s->card, &(s->dac_inst), s->index * 2);
  2052. setup_msrc(s->card, &(s->adc_inst), (s->index * 2) + 1);
  2053. return 0;
  2054. }
  2055. static void m3_amp_enable(struct m3_card *card, int enable)
  2056. {
  2057. /*
  2058. * this works for the reference board, have to find
  2059. * out about others
  2060. *
  2061. * this needs more magic for 4 speaker, but..
  2062. */
  2063. int io = card->iobase;
  2064. u16 gpo, polarity_port, polarity;
  2065. if(!external_amp)
  2066. return;
  2067. if (gpio_pin >= 0 && gpio_pin <= 15) {
  2068. polarity_port = 0x1000 + (0x100 * gpio_pin);
  2069. } else {
  2070. switch (card->card_type) {
  2071. case ESS_ALLEGRO:
  2072. polarity_port = 0x1800;
  2073. break;
  2074. default:
  2075. polarity_port = 0x1100;
  2076. /* Panasonic toughbook CF72 has to be different... */
  2077. if(card->pcidev->subsystem_vendor == 0x10F7 && card->pcidev->subsystem_device == 0x833D)
  2078. polarity_port = 0x1D00;
  2079. break;
  2080. }
  2081. }
  2082. gpo = (polarity_port >> 8) & 0x0F;
  2083. polarity = polarity_port >> 12;
  2084. if ( enable )
  2085. polarity = !polarity;
  2086. polarity = polarity << gpo;
  2087. gpo = 1 << gpo;
  2088. outw(~gpo , io + GPIO_MASK);
  2089. outw( inw(io + GPIO_DIRECTION) | gpo ,
  2090. io + GPIO_DIRECTION);
  2091. outw( (GPO_SECONDARY_AC97 | GPO_PRIMARY_AC97 | polarity) ,
  2092. io + GPIO_DATA);
  2093. outw(0xffff , io + GPIO_MASK);
  2094. }
  2095. static int
  2096. maestro_config(struct m3_card *card)
  2097. {
  2098. struct pci_dev *pcidev = card->pcidev;
  2099. u32 n;
  2100. u8 t; /* makes as much sense as 'n', no? */
  2101. pci_read_config_dword(pcidev, PCI_ALLEGRO_CONFIG, &n);
  2102. n &= REDUCED_DEBOUNCE;
  2103. n |= PM_CTRL_ENABLE | CLK_DIV_BY_49 | USE_PCI_TIMING;
  2104. pci_write_config_dword(pcidev, PCI_ALLEGRO_CONFIG, n);
  2105. outb(RESET_ASSP, card->iobase + ASSP_CONTROL_B);
  2106. pci_read_config_dword(pcidev, PCI_ALLEGRO_CONFIG, &n);
  2107. n &= ~INT_CLK_SELECT;
  2108. if(card->card_type >= ESS_MAESTRO3) {
  2109. n &= ~INT_CLK_MULT_ENABLE;
  2110. n |= INT_CLK_SRC_NOT_PCI;
  2111. }
  2112. n &= ~( CLK_MULT_MODE_SELECT | CLK_MULT_MODE_SELECT_2 );
  2113. pci_write_config_dword(pcidev, PCI_ALLEGRO_CONFIG, n);
  2114. if(card->card_type <= ESS_ALLEGRO) {
  2115. pci_read_config_dword(pcidev, PCI_USER_CONFIG, &n);
  2116. n |= IN_CLK_12MHZ_SELECT;
  2117. pci_write_config_dword(pcidev, PCI_USER_CONFIG, n);
  2118. }
  2119. t = inb(card->iobase + ASSP_CONTROL_A);
  2120. t &= ~( DSP_CLK_36MHZ_SELECT | ASSP_CLK_49MHZ_SELECT);
  2121. t |= ASSP_CLK_49MHZ_SELECT;
  2122. t |= ASSP_0_WS_ENABLE;
  2123. outb(t, card->iobase + ASSP_CONTROL_A);
  2124. outb(RUN_ASSP, card->iobase + ASSP_CONTROL_B);
  2125. return 0;
  2126. }
  2127. static void m3_enable_ints(struct m3_card *card)
  2128. {
  2129. unsigned long io = card->iobase;
  2130. outw(ASSP_INT_ENABLE, io + HOST_INT_CTRL);
  2131. outb(inb(io + ASSP_CONTROL_C) | ASSP_HOST_INT_ENABLE,
  2132. io + ASSP_CONTROL_C);
  2133. }
  2134. static struct file_operations m3_audio_fops = {
  2135. .owner = THIS_MODULE,
  2136. .llseek = no_llseek,
  2137. .read = m3_read,
  2138. .write = m3_write,
  2139. .poll = m3_poll,
  2140. .ioctl = m3_ioctl,
  2141. .mmap = m3_mmap,
  2142. .open = m3_open,
  2143. .release = m3_release,
  2144. };
  2145. #ifdef CONFIG_PM
  2146. static int alloc_dsp_suspendmem(struct m3_card *card)
  2147. {
  2148. int len = sizeof(u16) * (REV_B_CODE_MEMORY_LENGTH + REV_B_DATA_MEMORY_LENGTH);
  2149. if( (card->suspend_mem = vmalloc(len)) == NULL)
  2150. return 1;
  2151. return 0;
  2152. }
  2153. static void free_dsp_suspendmem(struct m3_card *card)
  2154. {
  2155. if(card->suspend_mem)
  2156. vfree(card->suspend_mem);
  2157. }
  2158. #else
  2159. #define alloc_dsp_suspendmem(args...) 0
  2160. #define free_dsp_suspendmem(args...)
  2161. #endif
  2162. /*
  2163. * great day! this function is ugly as hell.
  2164. */
  2165. static int __devinit m3_probe(struct pci_dev *pci_dev, const struct pci_device_id *pci_id)
  2166. {
  2167. u32 n;
  2168. int i;
  2169. struct m3_card *card = NULL;
  2170. int ret = 0;
  2171. int card_type = pci_id->driver_data;
  2172. DPRINTK(DPMOD, "in maestro_install\n");
  2173. if (pci_enable_device(pci_dev))
  2174. return -EIO;
  2175. if (pci_set_dma_mask(pci_dev, M3_PCI_DMA_MASK)) {
  2176. printk(KERN_ERR PFX "architecture does not support limiting to 28bit PCI bus addresses\n");
  2177. return -ENODEV;
  2178. }
  2179. pci_set_master(pci_dev);
  2180. if( (card = kmalloc(sizeof(struct m3_card), GFP_KERNEL)) == NULL) {
  2181. printk(KERN_WARNING PFX "out of memory\n");
  2182. return -ENOMEM;
  2183. }
  2184. memset(card, 0, sizeof(struct m3_card));
  2185. card->pcidev = pci_dev;
  2186. init_waitqueue_head(&card->suspend_queue);
  2187. if ( ! request_region(pci_resource_start(pci_dev, 0),
  2188. pci_resource_len (pci_dev, 0), M3_MODULE_NAME)) {
  2189. printk(KERN_WARNING PFX "unable to reserve I/O space.\n");
  2190. ret = -EBUSY;
  2191. goto out;
  2192. }
  2193. card->iobase = pci_resource_start(pci_dev, 0);
  2194. if(alloc_dsp_suspendmem(card)) {
  2195. printk(KERN_WARNING PFX "couldn't alloc %d bytes for saving dsp state on suspend\n",
  2196. REV_B_CODE_MEMORY_LENGTH + REV_B_DATA_MEMORY_LENGTH);
  2197. ret = -ENOMEM;
  2198. goto out;
  2199. }
  2200. card->card_type = card_type;
  2201. card->irq = pci_dev->irq;
  2202. card->next = devs;
  2203. card->magic = M3_CARD_MAGIC;
  2204. spin_lock_init(&card->lock);
  2205. spin_lock_init(&card->ac97_lock);
  2206. devs = card;
  2207. for(i = 0; i<NR_DSPS; i++) {
  2208. struct m3_state *s = &(card->channels[i]);
  2209. s->dev_audio = -1;
  2210. }
  2211. printk(KERN_INFO PFX "Configuring ESS %s found at IO 0x%04X IRQ %d\n",
  2212. card_names[card->card_type], card->iobase, card->irq);
  2213. pci_read_config_dword(pci_dev, PCI_SUBSYSTEM_VENDOR_ID, &n);
  2214. printk(KERN_INFO PFX " subvendor id: 0x%08x\n",n);
  2215. maestro_config(card);
  2216. m3_assp_halt(card);
  2217. m3_codec_reset(card, 0);
  2218. if(m3_codec_install(card)) {
  2219. ret = -EIO;
  2220. goto out;
  2221. }
  2222. m3_assp_init(card);
  2223. m3_amp_enable(card, 1);
  2224. for(i=0;i<NR_DSPS;i++) {
  2225. struct m3_state *s=&card->channels[i];
  2226. s->index = i;
  2227. s->card = card;
  2228. init_waitqueue_head(&s->dma_adc.wait);
  2229. init_waitqueue_head(&s->dma_dac.wait);
  2230. init_waitqueue_head(&s->open_wait);
  2231. init_MUTEX(&(s->open_sem));
  2232. s->magic = M3_STATE_MAGIC;
  2233. m3_assp_client_init(s);
  2234. if(s->dma_adc.ready || s->dma_dac.ready || s->dma_adc.rawbuf)
  2235. printk(KERN_WARNING PFX "initing a dsp device that is already in use?\n");
  2236. /* register devices */
  2237. if ((s->dev_audio = register_sound_dsp(&m3_audio_fops, -1)) < 0) {
  2238. break;
  2239. }
  2240. if( allocate_dmabuf(card->pcidev, &(s->dma_adc)) ||
  2241. allocate_dmabuf(card->pcidev, &(s->dma_dac))) {
  2242. ret = -ENOMEM;
  2243. goto out;
  2244. }
  2245. }
  2246. if(request_irq(card->irq, m3_interrupt, SA_SHIRQ, card_names[card->card_type], card)) {
  2247. printk(KERN_ERR PFX "unable to allocate irq %d,\n", card->irq);
  2248. ret = -EIO;
  2249. goto out;
  2250. }
  2251. pci_set_drvdata(pci_dev, card);
  2252. m3_enable_ints(card);
  2253. m3_assp_continue(card);
  2254. out:
  2255. if(ret) {
  2256. if(card->iobase)
  2257. release_region(pci_resource_start(pci_dev, 0), pci_resource_len(pci_dev, 0));
  2258. free_dsp_suspendmem(card);
  2259. if(card->ac97) {
  2260. unregister_sound_mixer(card->ac97->dev_mixer);
  2261. kfree(card->ac97);
  2262. }
  2263. for(i=0;i<NR_DSPS;i++)
  2264. {
  2265. struct m3_state *s = &card->channels[i];
  2266. if(s->dev_audio != -1)
  2267. unregister_sound_dsp(s->dev_audio);
  2268. }
  2269. kfree(card);
  2270. }
  2271. return ret;
  2272. }
  2273. static void m3_remove(struct pci_dev *pci_dev)
  2274. {
  2275. struct m3_card *card;
  2276. unregister_reboot_notifier(&m3_reboot_nb);
  2277. while ((card = devs)) {
  2278. int i;
  2279. devs = devs->next;
  2280. free_irq(card->irq, card);
  2281. unregister_sound_mixer(card->ac97->dev_mixer);
  2282. kfree(card->ac97);
  2283. for(i=0;i<NR_DSPS;i++)
  2284. {
  2285. struct m3_state *s = &card->channels[i];
  2286. if(s->dev_audio < 0)
  2287. continue;
  2288. unregister_sound_dsp(s->dev_audio);
  2289. free_dmabuf(card->pcidev, &s->dma_adc);
  2290. free_dmabuf(card->pcidev, &s->dma_dac);
  2291. }
  2292. release_region(card->iobase, 256);
  2293. free_dsp_suspendmem(card);
  2294. kfree(card);
  2295. }
  2296. devs = NULL;
  2297. }
  2298. /*
  2299. * some bioses like the sound chip to be powered down
  2300. * at shutdown. We're just calling _suspend to
  2301. * achieve that..
  2302. */
  2303. static int m3_notifier(struct notifier_block *nb, unsigned long event, void *buf)
  2304. {
  2305. struct m3_card *card;
  2306. DPRINTK(DPMOD, "notifier suspending all cards\n");
  2307. for(card = devs; card != NULL; card = card->next) {
  2308. if(!card->in_suspend)
  2309. m3_suspend(card->pcidev, PMSG_SUSPEND); /* XXX legal? */
  2310. }
  2311. return 0;
  2312. }
  2313. static int m3_suspend(struct pci_dev *pci_dev, pm_message_t state)
  2314. {
  2315. unsigned long flags;
  2316. int i;
  2317. struct m3_card *card = pci_get_drvdata(pci_dev);
  2318. /* must be a better way.. */
  2319. spin_lock_irqsave(&card->lock, flags);
  2320. DPRINTK(DPMOD, "pm in dev %p\n",card);
  2321. for(i=0;i<NR_DSPS;i++) {
  2322. struct m3_state *s = &card->channels[i];
  2323. if(s->dev_audio == -1)
  2324. continue;
  2325. DPRINTK(DPMOD, "stop_adc/dac() device %d\n",i);
  2326. stop_dac(s);
  2327. stop_adc(s);
  2328. }
  2329. mdelay(10); /* give the assp a chance to idle.. */
  2330. m3_assp_halt(card);
  2331. if(card->suspend_mem) {
  2332. int index = 0;
  2333. DPRINTK(DPMOD, "saving code\n");
  2334. for(i = REV_B_CODE_MEMORY_BEGIN ; i <= REV_B_CODE_MEMORY_END; i++)
  2335. card->suspend_mem[index++] =
  2336. m3_assp_read(card, MEMTYPE_INTERNAL_CODE, i);
  2337. DPRINTK(DPMOD, "saving data\n");
  2338. for(i = REV_B_DATA_MEMORY_BEGIN ; i <= REV_B_DATA_MEMORY_END; i++)
  2339. card->suspend_mem[index++] =
  2340. m3_assp_read(card, MEMTYPE_INTERNAL_DATA, i);
  2341. }
  2342. DPRINTK(DPMOD, "powering down apci regs\n");
  2343. m3_outw(card, 0xffff, 0x54);
  2344. m3_outw(card, 0xffff, 0x56);
  2345. card->in_suspend = 1;
  2346. spin_unlock_irqrestore(&card->lock, flags);
  2347. return 0;
  2348. }
  2349. static int m3_resume(struct pci_dev *pci_dev)
  2350. {
  2351. unsigned long flags;
  2352. int index;
  2353. int i;
  2354. struct m3_card *card = pci_get_drvdata(pci_dev);
  2355. spin_lock_irqsave(&card->lock, flags);
  2356. card->in_suspend = 0;
  2357. DPRINTK(DPMOD, "resuming\n");
  2358. /* first lets just bring everything back. .*/
  2359. DPRINTK(DPMOD, "bringing power back on card 0x%p\n",card);
  2360. m3_outw(card, 0, 0x54);
  2361. m3_outw(card, 0, 0x56);
  2362. DPRINTK(DPMOD, "restoring pci configs and reseting codec\n");
  2363. maestro_config(card);
  2364. m3_assp_halt(card);
  2365. m3_codec_reset(card, 1);
  2366. DPRINTK(DPMOD, "restoring dsp code card\n");
  2367. index = 0;
  2368. for(i = REV_B_CODE_MEMORY_BEGIN ; i <= REV_B_CODE_MEMORY_END; i++)
  2369. m3_assp_write(card, MEMTYPE_INTERNAL_CODE, i,
  2370. card->suspend_mem[index++]);
  2371. for(i = REV_B_DATA_MEMORY_BEGIN ; i <= REV_B_DATA_MEMORY_END; i++)
  2372. m3_assp_write(card, MEMTYPE_INTERNAL_DATA, i,
  2373. card->suspend_mem[index++]);
  2374. /* tell the dma engine to restart itself */
  2375. m3_assp_write(card, MEMTYPE_INTERNAL_DATA,
  2376. KDATA_DMA_ACTIVE, 0);
  2377. DPRINTK(DPMOD, "resuming dsp\n");
  2378. m3_assp_continue(card);
  2379. DPRINTK(DPMOD, "enabling ints\n");
  2380. m3_enable_ints(card);
  2381. /* bring back the old school flavor */
  2382. for(i = 0; i < SOUND_MIXER_NRDEVICES ; i++) {
  2383. int state = card->ac97->mixer_state[i];
  2384. if (!supported_mixer(card->ac97, i))
  2385. continue;
  2386. card->ac97->write_mixer(card->ac97, i,
  2387. state & 0xff, (state >> 8) & 0xff);
  2388. }
  2389. m3_amp_enable(card, 1);
  2390. /*
  2391. * now we flip on the music
  2392. */
  2393. for(i=0;i<NR_DSPS;i++) {
  2394. struct m3_state *s = &card->channels[i];
  2395. if(s->dev_audio == -1)
  2396. continue;
  2397. /*
  2398. * db->ready makes it so these guys can be
  2399. * called unconditionally..
  2400. */
  2401. DPRINTK(DPMOD, "turning on dacs ind %d\n",i);
  2402. start_dac(s);
  2403. start_adc(s);
  2404. }
  2405. spin_unlock_irqrestore(&card->lock, flags);
  2406. /*
  2407. * all right, we think things are ready,
  2408. * wake up people who were using the device
  2409. * when we suspended
  2410. */
  2411. wake_up(&card->suspend_queue);
  2412. return 0;
  2413. }
  2414. MODULE_AUTHOR("Zach Brown <zab@zabbo.net>");
  2415. MODULE_DESCRIPTION("ESS Maestro3/Allegro Driver");
  2416. MODULE_LICENSE("GPL");
  2417. #ifdef M_DEBUG
  2418. module_param(debug, int, 0);
  2419. #endif
  2420. module_param(external_amp, int, 0);
  2421. module_param(gpio_pin, int, 0);
  2422. static struct pci_driver m3_pci_driver = {
  2423. .name = "ess_m3_audio",
  2424. .id_table = m3_id_table,
  2425. .probe = m3_probe,
  2426. .remove = m3_remove,
  2427. .suspend = m3_suspend,
  2428. .resume = m3_resume,
  2429. };
  2430. static int __init m3_init_module(void)
  2431. {
  2432. printk(KERN_INFO PFX "version " DRIVER_VERSION " built at " __TIME__ " " __DATE__ "\n");
  2433. if (register_reboot_notifier(&m3_reboot_nb)) {
  2434. printk(KERN_WARNING PFX "reboot notifier registration failed\n");
  2435. return -ENODEV; /* ? */
  2436. }
  2437. if (pci_register_driver(&m3_pci_driver)) {
  2438. unregister_reboot_notifier(&m3_reboot_nb);
  2439. return -ENODEV;
  2440. }
  2441. return 0;
  2442. }
  2443. static void __exit m3_cleanup_module(void)
  2444. {
  2445. pci_unregister_driver(&m3_pci_driver);
  2446. }
  2447. module_init(m3_init_module);
  2448. module_exit(m3_cleanup_module);
  2449. void check_suspend(struct m3_card *card)
  2450. {
  2451. DECLARE_WAITQUEUE(wait, current);
  2452. if(!card->in_suspend)
  2453. return;
  2454. card->in_suspend++;
  2455. add_wait_queue(&card->suspend_queue, &wait);
  2456. set_current_state(TASK_UNINTERRUPTIBLE);
  2457. schedule();
  2458. remove_wait_queue(&card->suspend_queue, &wait);
  2459. set_current_state(TASK_RUNNING);
  2460. }