maestro3.c 85 KB

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